#include 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() { pinMode(A0,INPUT); pinMode(A1,INPUT); delay(3000); } void loop() { if(digitalRead(A0)==0 && digitalRead(A1)==0) { motor1.run(FORWARD); motor1.setSpeed(150); motor2.run(FORWARD); motor2.setSpeed(150); motor3.run(FORWARD); motor3.setSpeed(150); motor4.run(FORWARD); motor4.setSpeed(150); } else if(digitalRead(A0)==0 && !digitalRead(A1)==0) { motor1.run(FORWARD); motor1.setSpeed(190); motor2.run(FORWARD); motor2.setSpeed(190); motor3.run(BACKWARD); motor3.setSpeed(190); motor4.run(BACKWARD); motor4.setSpeed(190); } else if(!digitalRead(A0)==0 && digitalRead(A1)==0) { motor1.run(BACKWARD); motor1.setSpeed(190); motor2.run(BACKWARD); motor2.setSpeed(190); motor3.run(FORWARD); motor3.setSpeed(190); motor4.run(FORWARD); motor4.setSpeed(190); } else if(!digitalRead(A0)==0 && !digitalRead(A1)==0) { motor1.run(RELEASE); motor1.setSpeed(0); motor2.run(RELEASE); motor2.setSpeed(0); motor3.run(RELEASE); motor3.setSpeed(0); motor4.run(RELEASE); motor4.setSpeed(0); } }