Advertisement
Bosssu

follow torch 1

Jan 13th, 2015
281
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
text 1.47 KB | None | 0 0
  1. #include <atx.h>
  2. void setup()
  3. {
  4. sw1_press();
  5. }
  6. void loop()
  7. {
  8. int i = analogRead(2);
  9. lcd ("#c%d",i);
  10.  
  11. if(i>600)
  12. {
  13. motor_stop(ALL);
  14. sw1_press();
  15. }
  16. else
  17. {
  18. forward(20);
  19. }
  20. }
  21.  
  22.  
  23. void forward(int power)
  24. {
  25. motor(0,power);
  26. motor(1,power);
  27. motor(2,power);
  28. motor(3,power);
  29. }
  30.  
  31. void spin_left(int power)
  32. {
  33. motor(0,-power);
  34. motor(1,-power);
  35. motor(2,power);
  36. motor(3,power);
  37. }
  38.  
  39. void spin_right(int power)
  40. {
  41. motor(0,power);
  42. motor(1,power);
  43. motor(2,-power);
  44. motor(3,-power);
  45. }
  46. void forwardt(int power,int ms)
  47. {
  48. motor(0,power);
  49. motor(1,power);
  50. motor(2,power);
  51. motor(3,power);
  52. delay(ms);
  53. motor_stop(ALL);
  54. }
  55. void spin_leftt(int power,int ms)
  56. {
  57. motor(0,-power);
  58. motor(1,-power);
  59. motor(2,power);
  60. motor(3,power);
  61. delay(ms);
  62. motor_stop(ALL);
  63. }
  64.  
  65. void spin_rightt(int power,int ms)
  66. {
  67. motor(0,power);
  68. motor(1,power);
  69. motor(2,-power);
  70. motor(3,-power);
  71. delay(ms);
  72. motor_stop(ALL);
  73. }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement