Advertisement
Not a member of Pastebin yet?
Sign Up,
it unlocks many cool features!
- #include <AFMotor.h>
- AF_DCMotor motor1(1, MOTOR12_1KHZ);
- AF_DCMotor motor2(2, MOTOR12_1KHZ);
- AF_DCMotor motor3(3, MOTOR34_1KHZ);
- AF_DCMotor motor4(4, MOTOR34_1KHZ);
- void setup() {
- Serial.begin(9600); // Initialize serial monitor
- }
- void loop() {
- moveForward();
- delay(2000); // Move forward for 2 seconds
- moveBackward();
- delay(2000); // Move backward for 2 seconds
- turnLeft();
- delay(2000); // Turn left for 2 seconds
- turnRight();
- delay(2000); // Turn right for 2 seconds
- moveStop();
- delay(2000); // Stop for 2 seconds
- }
- void moveStop() {
- Serial.println("Stopping");
- motor1.run(RELEASE);
- motor2.run(RELEASE);
- motor3.run(RELEASE);
- motor4.run(RELEASE);
- }
- void moveForward() {
- Serial.println("Moving Forward");
- motor1.setSpeed(255);
- motor2.setSpeed(255);
- motor3.setSpeed(255);
- motor4.setSpeed(255);
- motor1.run(FORWARD);
- motor2.run(FORWARD);
- motor3.run(FORWARD);
- motor4.run(FORWARD);
- }
- void moveBackward() {
- Serial.println("Moving Backward");
- motor1.setSpeed(255);
- motor2.setSpeed(255);
- motor3.setSpeed(255);
- motor4.setSpeed(255);
- motor1.run(BACKWARD);
- motor2.run(BACKWARD);
- motor3.run(BACKWARD);
- motor4.run(BACKWARD);
- }
- void turnRight() {
- Serial.println("Turning Right");
- motor1.setSpeed(255);
- motor2.setSpeed(255);
- motor3.setSpeed(255);
- motor4.setSpeed(255);
- motor1.run(BACKWARD);
- motor2.run(FORWARD);
- motor3.run(FORWARD);
- motor4.run(BACKWARD);
- }
- void turnLeft() {
- Serial.println("Turning Left");
- motor1.setSpeed(255);
- motor2.setSpeed(255);
- motor3.setSpeed(255);
- motor4.setSpeed(255);
- motor1.run(FORWARD);
- motor2.run(BACKWARD);
- motor3.run(BACKWARD);
- motor4.run(FORWARD);
- }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement