Advertisement
Not a member of Pastebin yet?
Sign Up,
it unlocks many cool features!
- import RPi.GPIO as gpio
- import time
- pin17 = 17
- pin22 = 22
- pin23 = 23
- pin24 = 24
- speed = 50
- pwm_17 = None
- pwm_22 = None
- pwm_23 = None
- pwm_24 = None
- def init():
- gpio.setmode(gpio.BCM)
- gpio.setup(pin17, gpio.OUT)
- gpio.setup(pin22, gpio.OUT)
- gpio.setup(pin23, gpio.OUT)
- gpio.setup(pin24, gpio.OUT)
- pwm_17 = GPIO.PWM(pin17, 500)
- pwm_22 = GPIO.PWM(pin22, 500)
- pwm_23 = GPIO.PWM(pin23, 500)
- pwm_24 = GPIO.PWM(pin24, 500)
- pwm_17.start(0)
- pwm_22.start(0)
- pwm_23.start(0)
- pwm_24.start(0)
- def setSpeed():
- pwm_17.ChangeDutyCycle(int(speed))
- pwm_22.ChangeDutyCycle(int(speed))
- pwm_23.ChangeDutyCycle(int(speed))
- pwm_24.ChangeDutyCycle(int(speed))
- def forward(sec):
- init()
- gpio.output(pin17, True)
- gpio.output(pin23, True)
- gpio.output(pin22, False)
- gpio.output(pin24, False)
- time.sleep(sec)
- gpio.cleanup()
- def reverse(sec):
- init()
- gpio.output(pin22, True)
- gpio.output(pin24, True)
- gpio.output(pin17, False)
- gpio.output(pin23, False)
- time.sleep(sec)
- gpio.cleanup()
- setSpeed()
- print("forward")
- forward(4)
- print("reverse")
- reverse(2)
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement