Advertisement
Guest User

Untitled

a guest
Sep 19th, 2019
88
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
text 0.99 KB | None | 0 0
  1. #include <Servo.h>
  2.  
  3. Servo servo_pin_11;
  4. Servo servo_pin_10;
  5.  
  6. void Stop();
  7. void left();
  8. void Forward(int iDelay);
  9. void right();
  10.  
  11. void setup()
  12. {
  13. servo_pin_11.attach(11);
  14. servo_pin_10.attach(10);
  15.  
  16. Forward(4);
  17.  
  18. left();
  19.  
  20. Forward(4);
  21.  
  22. left();
  23.  
  24. Forward(3);
  25.  
  26. right();
  27.  
  28. Forward(3.7);
  29.  
  30. right();
  31.  
  32. Forward(8);
  33.  
  34. right();
  35.  
  36. Forward(3.7);
  37.  
  38. right();
  39.  
  40. Forward(2);
  41.  
  42. left();
  43.  
  44. Forward(4);
  45.  
  46. left();
  47.  
  48. Forward(8);
  49.  
  50. left();
  51.  
  52. Forward(10);
  53.  
  54. left();
  55.  
  56. Forward(2);
  57.  
  58. left();
  59.  
  60. Forward(8);
  61.  
  62. Stop();
  63.  
  64. }
  65.  
  66. void loop()
  67. {
  68. }
  69.  
  70. void Stop()
  71. {
  72. servo_pin_11.write( 90 );
  73. servo_pin_10.write( 90 );
  74. delay( 999 );
  75. }
  76.  
  77. void right()
  78. {
  79. servo_pin_11.write( 135 );
  80. servo_pin_10.write( 135 );
  81. delay( 310 );
  82. }
  83.  
  84. void Forward(int iDelay)
  85. {
  86. servo_pin_11.write( 135 );
  87. servo_pin_10.write( 45 );
  88. delay( 480*iDelay );
  89. }
  90.  
  91. void left()
  92. {
  93. servo_pin_11.write( 45 );
  94. servo_pin_10.write( 45 );
  95. delay( 310 );
  96. }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement