Advertisement
Bosssu

CIRCLE RACE

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