Sensoren und Motorsteurung hinzugefuegt

This commit is contained in:
Kevin Frantz
2017-04-15 16:43:12 +00:00
parent 3df8ab165a
commit 2e82f991da
10 changed files with 85 additions and 22 deletions

View File

@@ -1,21 +1,28 @@
import RPi.GPIO as GPIO
from time import sleep
class Motor(object):
def __init__(self,directionPin,speedPin,directionForward):
self.directionPin=directionPin #BCM-Pin
self.speedPin=speedPin #BCM-Pin
self.directionForward=directionForward; #Enthaelt einen BOOL
self.changeSpeed(0)
self.speed=0;
GPIO.setup(self.directionPin, GPIO.OUT)
GPIO.setup(self.speedPin, GPIO.OUT)
self.stop()
GPIO.output(self.speedPin, 0)
GPIO.output(self.directionPin, 0)
def forward(self):
self.stop()
GPIO.output(self.directionPin,self.directionForward)
GPIO.output(self.speedPin,1)
GPIO.output(self.speedPin,(not self.directionForward))
def backward(self):
self.stop()
GPIO.output(self.directionPin,(not self.directionForward))
GPIO.output(self.speedPin,1)
GPIO.output(self.speedPin,self.directionForward)
def changeSpeed(self,speed):
self.speed=speed
def stop(self):
GPIO.output(self.speedPin, 0)
GPIO.output(self.directionPin, 0)
sleep(0.02)