Guest User

Motor controller test code

a guest
Jan 21st, 2017
37
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
Python 0.85 KB | None | 0 0
  1. import RPi.GPIO as GPIO
  2. import time
  3. from time import sleep
  4.  
  5. pwmpinL = 18
  6. pwmpinR = 19
  7. pwmfreq=10000 # set PWM frequency to 10Khz, compatible with slow slew mode on the motor controller
  8.  
  9. dc = 50 # percent duty cycle to test with
  10.  
  11. GPIO.setmode(GPIO.BCM) # set pin selection mode
  12. GPIO.setup(pwmpinL, GPIO.OUT) #set left motor's pin to output mode
  13. GPIO.setup(pwmpinR, GPIO.OUT) #set right motor's pin to output mode
  14.  
  15. pwmL = GPIO.PWM(pwmpinL, pwmfreq)
  16. pwmR = GPIO.PWM(pwmpinR, pwmfreq)
  17.  
  18. #GPIO.output(pwmpinL, GPIO.LOW)
  19.  
  20. print("Here we go! Press CTRL+C to exit")
  21.  
  22. pwmL.start(dc) #start running left motor at test duty cycle
  23.  
  24. sleep(5)
  25.  
  26. pwmL.ChangeFrequency(0) #stop left motor
  27.  
  28. pwmR.start(dc) #start running right motor at test duty cycle
  29.  
  30. sleep(5)
  31.  
  32. pwmR.ChangeFrequency(0) #stop right motor
  33.  
  34.  
  35. #GPIO.output(pwmpinL, GPIO.HIGH)
  36.  
  37. GPIO.cleanup()
Add Comment
Please, Sign In to add comment