Servo servo1;
Servo servo2;
Servo servo3;
Servo servo4;
int ON = 8;
int L= A1;
int R= A0;
char val;
boolean encendido = false;
void setup()
{
servo1.attach(11);
servo2.attach(10);
servo3.attach(9);
servo4.attach(6);
servo1.write(5); //ready
delay(950);
servo2.write(80); //ready
delay(950);
servo3.write(90); //ready
delay(950);
servo4.write(95); //ready
delay(950);
Serial.begin(9600);
pinMode (ON,OUTPUT);
pinMode (L,OUTPUT);
pinMode (R,OUTPUT);
digitalWrite(ON, LOW);
digitalWrite(L,LOW);
digitalWrite(R,LOW);
}
void loop()
{
if (Serial.available()) {
val = Serial.read();
if ((val == 'P')&&(encendido == false)){
digitalWrite(ON, HIGH);
encendido = true;
}else if ((val == 'P')&&(encendido == true)){
digitalWrite(ON, LOW);
encendido = false; //
}
if ((val == 'I')&&(encendido == false)){
digitalWrite(L, HIGH);
encendido = true;
}else if ((val == 'I')&&(encendido == true)){
digitalWrite(L, LOW);
encendido = false; //
}
if ((val == 'O')&&(encendido == false)){
digitalWrite(R, HIGH);
encendido = true;
}else if ((val == 'O')&&(encendido == true)){
digitalWrite(R, LOW);
encendido = false; //
}
if (val == 'W') {
servo1.write(10); //1
}
if (val == 'E') {
servo1.write(120); //1
}
if (val == 'A') {
servo2.write(10); //2
}
if (val == 'S') {
servo2.write(90); //2
}
if (val == 'D') {
servo2.write(140); //2
}
if (val == 'B') {
servo3.write(15); //3
}
if (val == 'N') {
servo3.write(90); //3
}
if (val == 'V') {
servo3.write(145); //3
}
if (val == 'Z') {
servo4.write(10); //4
}
if (val == 'X') {
servo4.write(90); //4
}
if (val == 'C') {
servo4.write(160); //4
}
}
}
Comments