Guest User

Untitled

a guest
Jan 16th, 2019
47
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
text 2.58 KB | None | 0 0
  1. def left_wheel_callback(pin):
  2. if (pin == 5):
  3. if (counter == 0):
  4. start_time = time.time()
  5. counter = 1
  6. else:
  7. left_pulse_time = time.time() - start_time
  8. left_vel = dist / left_pul_time
  9. left_rpm = (left_vel * 60) / (2 * math.pi * 7.5)
  10. counter = 0
  11. print("left encoder pul: ", left_pulse_time)
  12. print("left RPM: ", left_rpm)
  13.  
  14. def right_wheel_callback(pin):
  15. if (pin == 23):
  16. if (counter == 0):
  17. start_time = time.time()
  18. counter = 1
  19. else:
  20. right_pulse_time = time.time() - start_time
  21. right_vel = dist / right_pul_time
  22. right_rpm = (right_vel * 60) / (2 * math.pi * 7.5)
  23. counter = 0
  24. print("right encoder pul: ", right_pulse_time)
  25. print("right RPM: ", right_rpm)
  26.  
  27. GPIO.add_event_detect(5, GPIO.RISING, callback=left_wheel_callback)
  28. GPIO.add_event_detect(23, GPIO.RISING, callback=right_wheel_callback)
  29.  
  30. GPIO.add_event_detect(5, GPIO.RISING, callback=left_wheel_callback)
  31. #GPIO.add_event_detect(23, GPIO.RISING, callback=right_wheel_callback)
  32.  
  33. # simply commenting one callback out to test for both wheels respectively.
  34.  
  35. left encoder pul: 0.0592479705811
  36. left rpm: 28.1303587333
  37. left encoder pul: 0.0584199428558
  38. left rpm: 28.5290704714
  39. left encoder pul: 0.056792974472
  40. left rpm: 29.346352822
  41. left encoder pul: 0.0551149845123
  42. left rpm: 30.2398101245
  43. left encoder pul: 0.0555770397186
  44. left rpm: 29.9884030367
  45.  
  46. right encoder pul: 0.0564210414886
  47. right rpm: 29.539806829
  48. right encoder pul: 0.056529045105
  49. right rpm: 29.4833684802
  50. right encoder pul: 0.0555770397186
  51. right rpm: 29.9884030367
  52. right encoder pul: 0.0557889938354
  53. right rpm: 29.8744707887
  54. right encoder pul: 0.0559689998627
  55. right rpm: 29.7783893004
  56.  
  57. GPIO.add_event_detect(5, GPIO.RISING, callback=left_wheel_callback)
  58. GPIO.add_event_detect(23, GPIO.RISING, callback=right_wheel_callback)
  59.  
  60. # using both callbacks this time
  61.  
  62. left encoder pul: 0.0172209739685
  63. left rpm: 96.7812081776
  64. right encoder pul: 0.0593919754028
  65. right rpm: 28.0621524265
  66. left encoder pul: 0.00982093811035
  67. left rpm: 169.705444423
  68. right encoder pul: 0.0587668418884
  69. right rpm: 28.3606641621
  70. left encoder pul: 0.00218605995178
  71. left rpm: 762.406660123
  72. right encoder pul: 0.0027379989624
  73. right rpm: 608.717055614
  74. left encoder pul: 0.0545420646667
  75. left rpm: 30.5574546334
  76. right encoder pul: 0.0100808143616
  77. right rpm: 165.330558315
  78. left encoder pul: 0.0545239448547
  79. left rpm: 30.5676097191
  80. right encoder pul: 0.0164430141449
  81. right rpm: 101.360167423
Add Comment
Please, Sign In to add comment