#include <Servo.h>
Servo servo1;
Servo servo2;
Servo servo3;
Servo servo4;
int val;
void setup()
{
pinMode(13, OUTPUT);
digitalWrite(LED_BUILTIN, HIGH); // turn the LED on (HIGH is the voltage level)
delay(1000);
servo1.attach(9);
servo2.attach(10);
servo3.attach(11);
servo4.attach(6);
servo1.write(90); //ready
servo2.write(90); //ready
servo3.write(90); //ready
servo4.write(90); //ready
delay(950);
Serial.begin(9600);
}
void loop()
{
if (Serial.available()) {
val = Serial.read();
if (val == 'Q') {
servo1.write(10); //1
delay(950);
}
if (val == 'A') {
servo1.write(90); //1S
delay(950);
}
if (val == 'S') {
servo1.write(170); //1111111111111111111111111111111111111111111
delay(950);
}
if (val == 'R') {
servo2.write(10); //2
delay(950);
}
if (val == 'E') {
servo2.write(90); //2
delay(950);;
}
if (val == 'D') {
servo2.write(170); //22222222222222222222222222222222222222222222222
delay(950);;
}
if (val == 'F') {
servo3.write(12); //3
delay(950);
}
if (val == 'G') {
servo3.write(90); //3
delay(950);
}
if (val == 'H') {
servo3.write(170); //3333333333333333333333333333333333333333333333333333
delay(950);
}
if (val == 'T') {
servo4.write(12); //4
delay(950);
}
if (val == 'Y') {
servo4.write(90); //4
delay(950);
}
if (val == 'U') {
servo4.write(170); //4444444444444444444444444444444444444444444444444444444
delay(950);
}
if (val == 'J') {
servo1.write(12); //ALL
servo2.write(12); //ALL
servo3.write(12); //ALL
servo4.write(12); //ALL
delay(950);
}
if (val == 'K') {
servo1.write(90); //ALL
servo2.write(90); //ALL
servo3.write(90); //ALL
servo4.write(90); //ALL
delay(950);
}
if (val == 'L') {
servo1.write(170); //ALL
servo2.write(170); //ALL
servo3.write(170); //ALL
servo4.write(170); //ALL
delay(950);
}
}
}
Comments
Please log in or sign up to comment.