Advertisement
safwan092

Untitled

May 30th, 2022
50
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
text 1.21 KB | None | 0 0
  1. #include <AFMotor.h>
  2.  
  3. int motorSpeed = 100;
  4. int count = 0;
  5.  
  6. AF_DCMotor motor1(1);
  7. AF_DCMotor motor2(2);
  8. AF_DCMotor motor3(3);
  9. AF_DCMotor motor4(4);
  10.  
  11. void setup() {
  12. count = 0;
  13. motor1.setSpeed(motorSpeed);
  14. motor2.setSpeed(motorSpeed);
  15. motor3.setSpeed(motorSpeed);
  16. motor4.setSpeed(motorSpeed);
  17.  
  18. motor1.run(RELEASE);
  19. motor2.run(RELEASE);
  20. motor3.run(RELEASE);
  21. motor4.run(RELEASE);
  22.  
  23. }
  24.  
  25. void loop() {
  26. if (count < 3) {
  27. count++;
  28. FRONT();
  29. delay(1000);
  30. BACKWARDS();
  31. delay(1000);
  32. }
  33. else{
  34. STOPP();
  35. }
  36. /* LEFTT();
  37. delay(2000);
  38. RIGHTT();
  39. delay(2000);*/
  40. }
  41.  
  42.  
  43. void FRONT() {
  44. motor1.run(FORWARD);
  45. motor2.run(FORWARD);
  46. motor3.run(FORWARD);
  47. motor4.run(FORWARD);
  48. }
  49.  
  50. void BACKWARDS() {
  51. motor1.run(BACKWARD);
  52. motor2.run(BACKWARD);
  53. motor3.run(BACKWARD);
  54. motor4.run(BACKWARD);
  55. }
  56.  
  57. void LEFTT() {
  58. motor1.run(FORWARD);
  59. motor2.run(BACKWARD);
  60. motor4.run(FORWARD);
  61. motor3.run(BACKWARD);
  62. }
  63.  
  64. void RIGHTT() {
  65. motor1.run(BACKWARD);
  66. motor2.run(FORWARD);
  67. motor4.run(BACKWARD);
  68. motor3.run(FORWARD);
  69. }
  70.  
  71. void STOPP() {
  72. motor1.run(RELEASE);
  73. motor2.run(RELEASE);
  74. motor4.run(RELEASE);
  75. motor3.run(RELEASE);
  76. }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement