Advertisement
Bosssu

Project 1 complete (Motor)

Jul 1st, 2014
295
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
text 0.65 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,1000);
  14. turn_right(65,400);
  15. go_forward(100,1000);
  16. turn_right(65,400);
  17. go_forward(100,1000);
  18. turn_right(65,400);
  19. go_forward(100,1000);
  20. sw1_press();
  21. }
  22. void go_forward(int power,int ms)
  23. {
  24. motor(LFM,power);
  25. motor(LBM,power);
  26. motor(RFM,power);
  27. motor(RBM,power);
  28. delay(ms);
  29. motor_stop(ALL);
  30. }
  31. void turn_right(int power,int ms)
  32. {
  33. motor(LFM,power);
  34. motor(LBM,power);
  35. motor(RFM,-power);
  36. motor(RBM,-power);
  37. delay(ms);
  38. motor_stop(ALL);
  39. }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement