Advertisement
Guest User

Untitled

a guest
Oct 31st, 2014
136
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
text 1.41 KB | None | 0 0
  1. //Pins for motor A1,2
  2. const int MotorA1 = 6;
  3. const int MotorA2 = 7;
  4. //Pins for motor B1,2
  5. const int MotorB1 = 8;
  6. const int MotorB2 = 9;
  7. void setup() {
  8. pinMode(MotorA1, OUTPUT);
  9. pinMode(MotorA2, OUTPUT);
  10. pinMode(MotorB1, OUTPUT);
  11. pinMode(MotorB2, OUTPUT);
  12.  
  13. }
  14. void go(){
  15. digitalWrite (MotorA1, HIGH);
  16. digitalWrite (MotorA2, LOW);
  17. digitalWrite (MotorB1, HIGH);
  18. digitalWrite (MotorB2, LOW);
  19. }
  20.  
  21. void backwards(){
  22. digitalWrite (MotorA1 , LOW);
  23. digitalWrite (MotorA2, HIGH);
  24. digitalWrite (MotorB1, LOW);
  25. digitalWrite (MotorB2, HIGH);
  26. }
  27.  
  28. void turnleft(int t){
  29. digitalWrite (MotorA1, LOW);
  30. digitalWrite (MotorA2, HIGH);
  31. digitalWrite (MotorB1, HIGH);
  32. digitalWrite (MotorB2, LOW);
  33. delay(t);
  34. }
  35.  
  36. void turnright(int t){
  37. digitalWrite (MotorA1, HIGH);
  38. digitalWrite (MotorA2, LOW);
  39. digitalWrite (MotorB1, LOW);
  40. digitalWrite (MotorB2, HIGH);
  41. delay(t);
  42. }
  43.  
  44. void stopmove(){
  45. digitalWrite (MotorA1 ,LOW);
  46. digitalWrite (MotorA2, LOW);
  47. digitalWrite (MotorB1, LOW);
  48. digitalWrite (MotorB2, LOW);
  49. }
  50. void loop() {
  51. // put your main code here, to run repeatedly:
  52. go;
  53. delay(10000);
  54. backwards;
  55. delay (10000);
  56. turnleft;
  57. delay(1500);
  58. turnright;
  59. delay(1500);
  60. stopmove;
  61. delay (100000);
  62.  
  63. }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement