Advertisement
Bosssu

Project 4 complete (Motor)

Jul 15th, 2014
291
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
text 0.90 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(60,1200);
  14. turn_right(70,510);
  15. go_forward(60,2400);
  16. turn_left(70,500);
  17. go_forward(60,1300);
  18. turn_left(70,450);
  19. go_forward(60,1200);
  20. turn_left(70,460);
  21. go_forward(60,2500);
  22. turn_right(70,500);
  23. go_forward(60,1200);
  24. sw1_press();
  25. }
  26. void go_forward(int power,int ms)
  27. {
  28. motor(LFM,power);
  29. motor(LBM,power);
  30. motor(RFM,power);
  31. motor(RBM,power);
  32. delay(ms);
  33. motor_stop(ALL);
  34. }
  35. void turn_right(int power,int ms)
  36. {
  37. motor(LFM,power);
  38. motor(LBM,power);
  39. motor(RFM,-power);
  40. motor(RBM,-power);
  41. delay(ms);
  42. motor_stop(ALL);
  43. }
  44. void turn_left(int power,int ms)
  45. {
  46. motor(LFM,-power);
  47. motor(LBM,-power);
  48. motor(RFM,power);
  49. motor(RBM,power);
  50. delay(ms);
  51. motor_stop(ALL);
  52. }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement