Advertisement
LovelessIsma

puenteh3

Nov 6th, 2019
92
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
Python 1.18 KB | None | 0 0
  1. import RPi.GPIO as gpio
  2. import time
  3.  
  4. pin17 = 17
  5. pin22 = 22
  6. pin23 = 23
  7. pin24 = 24
  8.  
  9. speed = 50
  10.  
  11. pwm_17 = None
  12. pwm_22 = None
  13. pwm_23 = None
  14. pwm_24 = None
  15.  
  16. def init():
  17.     gpio.setmode(gpio.BCM)
  18.     gpio.setup(pin17, gpio.OUT)
  19.     gpio.setup(pin22, gpio.OUT)
  20.     gpio.setup(pin23, gpio.OUT)
  21.     gpio.setup(pin24, gpio.OUT)
  22.  
  23.     pwm_17 = GPIO.PWM(pin17, 500)
  24.     pwm_22 = GPIO.PWM(pin22, 500)
  25.     pwm_23 = GPIO.PWM(pin23, 500)
  26.     pwm_24 = GPIO.PWM(pin24, 500)
  27.  
  28.     pwm_17.start(0)
  29.     pwm_22.start(0)
  30.     pwm_23.start(0)
  31.     pwm_24.start(0)
  32.  
  33. def setSpeed():
  34.     pwm_17.ChangeDutyCycle(int(speed))
  35.     pwm_22.ChangeDutyCycle(int(speed))
  36.     pwm_23.ChangeDutyCycle(int(speed))
  37.     pwm_24.ChangeDutyCycle(int(speed))
  38.  
  39. def forward(sec):
  40.     init()
  41.     gpio.output(pin17, True)
  42.     gpio.output(pin23, True)
  43.     gpio.output(pin22, False)
  44.     gpio.output(pin24, False)
  45.     time.sleep(sec)
  46.     gpio.cleanup()
  47.  
  48. def reverse(sec):
  49.     init()
  50.     gpio.output(pin22, True)
  51.     gpio.output(pin24, True)
  52.     gpio.output(pin17, False)
  53.     gpio.output(pin23, False)
  54.     time.sleep(sec)
  55.     gpio.cleanup()
  56.  
  57. setSpeed()
  58. print("forward")
  59. forward(4)
  60. print("reverse")
  61. reverse(2)
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement