Advertisement
Bosssu

Race#5

Nov 25th, 2014
304
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
text 2.13 KB | None | 0 0
  1. #include <atx.h>
  2. #define BLACK 150
  3. #define LEFT_SENSOR 2
  4. #define RIGHT_SENSOR 3
  5. int state = 1;
  6. int ms;
  7.  
  8. void setup()
  9. {
  10. lcd("pressSW1");
  11. sw1_press();
  12. beep();
  13. }
  14. void loop()
  15. {
  16. int left = analogRead(LEFT_SENSOR);
  17. int right = analogRead(RIGHT_SENSOR);
  18. if(left < 200 && right < 200)
  19. {
  20. beep();
  21. switch(state)
  22. {
  23. case 1:
  24. {
  25. go_backward(50);
  26. delay(300);
  27. spin_right(100);
  28. delay(380);
  29.  
  30. break;
  31. }
  32. case 2:
  33. {
  34. go_backward(50);
  35. delay(300);
  36. spin_right(100);
  37. delay(350);
  38.  
  39. break;
  40. }
  41. case 3:
  42. {
  43. go_backward(50);
  44. delay(300);
  45. spin_right(100);
  46. delay(340);
  47.  
  48. break;
  49. }
  50. case 4:
  51. {
  52. go_backward(50);
  53. delay(300);
  54. spin_right(100);
  55. delay(350);
  56.  
  57. break;
  58. }
  59. case 5:
  60. {
  61. go_backward(50);
  62. delay(300);
  63. spin_right(100);
  64. delay(350);
  65.  
  66. break;
  67. }
  68. case 6:
  69. {
  70. go_backward(50);
  71. delay(300);
  72. spin_left(100);
  73. delay(350);
  74.  
  75. break;
  76. }
  77. case 7:
  78. {
  79. go_backward(50);
  80. delay(300);
  81. spin_left(100);
  82. delay(350);
  83.  
  84. break;
  85. }
  86. default:
  87. {
  88. motor_stop(ALL);
  89. sw1_press();
  90. }
  91. }
  92. state = state + 1;
  93. }
  94. else if(left < 200)
  95. {
  96. spin_left(50);
  97. }
  98. else if(right < 200)
  99. {
  100. spin_right(50);
  101. }
  102. else
  103. {
  104. go_forward(60);
  105. }
  106. }
  107.  
  108. void spin_left(int t_power)
  109. {
  110. motor(0,t_power);
  111. motor(1,t_power);
  112. motor(2,-t_power);
  113. motor(3,-t_power);
  114. }
  115.  
  116. void spin_right(int t_power)
  117. {
  118. motor(0,-t_power);
  119. motor(1,-t_power);
  120. motor(2,t_power);
  121. motor(3,t_power);
  122. }
  123.  
  124. void go_forward(int f_power)
  125. {
  126. motor(0,f_power);
  127. motor(1,f_power);
  128. motor(2,f_power);
  129. motor(3,f_power);
  130. }
  131.  
  132. void go_backward(int b_power)
  133. {
  134. motor(0,-b_power);
  135. motor(1,-b_power);
  136. motor(2,-b_power);
  137. motor(3,-b_power);
  138. }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement