#include <Servo.h>
Servo servo1;
Servo servo2;
int buttonState0 = 0;
int buttonState1 = 0;
int buttonState2 = 0;
int buttonState3 = 0;
int buttonPin0 = A0;
int buttonPin1 = A1;
int buttonPin2 = A2;
int buttonPin3 = A3;
void setup() {
servo1.attach(9);
servo2.attach(10);
pinMode(buttonPin0, INPUT_PULLUP);
pinMode(buttonPin1, INPUT_PULLUP);
pinMode(buttonPin2, INPUT_PULLUP);
pinMode(buttonPin3, INPUT_PULLUP);
}
void loop() {
buttonState0 = digitalRead(buttonPin0);
buttonState1 = digitalRead(buttonPin1);
buttonState2 = digitalRead(buttonPin2);
buttonState3 = digitalRead(buttonPin3);
if (buttonState0 == LOW) { //forward
servo1.write(180);
servo2.write(0);
} else if (buttonState1 == LOW) { //left
servo1.write(90);
servo2.write(0);
} else if (buttonState2 == LOW) { //right
servo1.write(180);
servo2.write(90);
} else if (buttonState3 == LOW) { //reverse
servo1.write(0);
servo2.write(180);
} else { //stop
servo1.write(90);
servo2.write(90);
}
}