Advertisement
rhandycan1

TEST_CODE_L293D

May 31st, 2025
255
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
C++ 1.75 KB | Source Code | 0 0
  1. #include <AFMotor.h>
  2.  
  3. AF_DCMotor motor1(1, MOTOR12_1KHZ);
  4. AF_DCMotor motor2(2, MOTOR12_1KHZ);
  5. AF_DCMotor motor3(3, MOTOR34_1KHZ);
  6. AF_DCMotor motor4(4, MOTOR34_1KHZ);
  7.  
  8. void setup() {
  9.   Serial.begin(9600); // Initialize serial monitor
  10. }
  11.  
  12. void loop() {
  13.   moveForward();
  14.   delay(2000); // Move forward for 2 seconds
  15.  
  16.   moveBackward();
  17.   delay(2000); // Move backward for 2 seconds
  18.  
  19.   turnLeft();
  20.   delay(2000); // Turn left for 2 seconds
  21.  
  22.   turnRight();
  23.   delay(2000); // Turn right for 2 seconds
  24.  
  25.   moveStop();
  26.   delay(2000); // Stop for 2 seconds
  27. }
  28.  
  29. void moveStop() {
  30.   Serial.println("Stopping");
  31.   motor1.run(RELEASE);
  32.   motor2.run(RELEASE);
  33.   motor3.run(RELEASE);
  34.   motor4.run(RELEASE);
  35. }
  36.  
  37. void moveForward() {
  38.   Serial.println("Moving Forward");
  39.   motor1.setSpeed(255);
  40.   motor2.setSpeed(255);
  41.   motor3.setSpeed(255);
  42.   motor4.setSpeed(255);
  43.   motor1.run(FORWARD);      
  44.   motor2.run(FORWARD);
  45.   motor3.run(FORWARD);
  46.   motor4.run(FORWARD);    
  47. }
  48.  
  49. void moveBackward() {
  50.   Serial.println("Moving Backward");
  51.   motor1.setSpeed(255);
  52.   motor2.setSpeed(255);
  53.   motor3.setSpeed(255);
  54.   motor4.setSpeed(255);
  55.   motor1.run(BACKWARD);      
  56.   motor2.run(BACKWARD);
  57.   motor3.run(BACKWARD);
  58.   motor4.run(BACKWARD);  
  59. }  
  60.  
  61. void turnRight() {
  62.   Serial.println("Turning Right");
  63.   motor1.setSpeed(255);
  64.   motor2.setSpeed(255);
  65.   motor3.setSpeed(255);
  66.   motor4.setSpeed(255);
  67.   motor1.run(BACKWARD);
  68.   motor2.run(FORWARD);
  69.   motor3.run(FORWARD);
  70.   motor4.run(BACKWARD);
  71. }
  72.  
  73. void turnLeft() {
  74.   Serial.println("Turning Left");
  75.   motor1.setSpeed(255);
  76.   motor2.setSpeed(255);
  77.   motor3.setSpeed(255);
  78.   motor4.setSpeed(255);
  79.   motor1.run(FORWARD);
  80.   motor2.run(BACKWARD);
  81.   motor3.run(BACKWARD);
  82.   motor4.run(FORWARD);
  83. }
  84.  
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement