Advertisement
Bosssu

Project 3 complete (Motor)

Jul 8th, 2014
292
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
text 1.00 KB | None | 0 0
  1. #include <atx.h>
  2. #define LFM 0
  3. #define LBM 1
  4. #define RFM 5
  5. #define RBM 4
  6.  
  7. void setup()
  8. {
  9. sw1_press();
  10. }
  11. void loop()
  12. {
  13. go_forward(100,1200);
  14. turn_right(70,750);
  15. go_forward(100,1200);
  16. turn_left(70,750);
  17. go_forward(100,1300);
  18. turn_left(70,750);
  19. go_forward(100,1200);
  20. turn_left(70,700);
  21. go_forward(100,1200);
  22. turn_left(70,700);
  23. go_forward(100,1200);
  24. turn_right(70,750);
  25. go_forward(100,1200);
  26. turn_right(70,750);
  27. go_forward(100,1200);
  28. sw1_press();
  29. }
  30. void go_forward(int power,int ms)
  31. {
  32. motor(LFM,power);
  33. motor(LBM,power);
  34. motor(RFM,power);
  35. motor(RBM,power);
  36. delay(ms);
  37. motor_stop(ALL);
  38. }
  39. void turn_right(int power,int ms)
  40. {
  41. motor(LFM,power);
  42. motor(LBM,power);
  43. motor(RFM,-power);
  44. motor(RBM,-power);
  45. delay(ms);
  46. motor_stop(ALL);
  47. }
  48. void turn_left(int power,int ms)
  49. {
  50. motor(LFM,-power);
  51. motor(LBM,-power);
  52. motor(RFM,power);
  53. motor(RBM,power);
  54. delay(ms);
  55. motor_stop(ALL);
  56. }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement