// Servo Library
#include <Servo.h>
Servo Servo1;
Servo Servo2;
int ServoValue[2] = {0, 0};
void setup() {
Serial.begin(9600);
Servo1.attach(A0);
Servo2.attach(A1);
Servo1.write(0);
Servo2.write(0);
Servo1.write(10);
Servo2.write(10);
}
void loop() {
if(Serial.available() > 0) {
char input = Serial.read();
Serial.print("[ACHIEVED INPUT] ");
Serial.print(input);
Serial.print("\n");
switch(input) {
case 'R':
if(ServoValue[0] < 180) {
ServoValue[0] += 2;
Servo1.write(ServoValue[0]);
}
break;
case 'L':
if(ServoValue[0] > 0) {
ServoValue[0] -= 2;
Servo1.write(ServoValue[0]);
} else {
ServoValue[0] = 0;
}
break;
case 'U':
if(ServoValue[0] < 180) {
ServoValue[1] += 2;
Servo2.write(ServoValue[0]);
}
break;
case 'D':
if(ServoValue[0] > 0) {
ServoValue[1] -= 2;
Servo2.write(ServoValue[0]);
} else {
ServoValue[1] = 0;
}
break;
}
}
}