#include <Servo.h>
Servo servo1;
Servo servo2;
Servo servo3;
Servo servo4;
int OMEGA=13;
int FLECHA=12;
int in1 = 22;
int in2 = 23;
int in3 = 24;
int in4 = 25;
int en1 = 14;
int en2 = 15;
int incomingByte;
void setup() {
pinMode(in1, OUTPUT);
pinMode(in2, OUTPUT);
pinMode(in3, OUTPUT);
pinMode(in4, OUTPUT);
pinMode(en1, OUTPUT);
pinMode(en2, OUTPUT);
pinMode(OMEGA, OUTPUT);
pinMode(FLECHA, OUTPUT);
servo1.attach(2);
servo2.attach(3);
servo3.attach(4);
servo4.attach(5);
digitalWrite(FLECHA, HIGH);
servo1.write(90); //ready
servo2.write(10); //ready
servo3.write(90); //ready
servo4.write(170); //ready
digitalWrite(OMEGA, HIGH); // tO
Serial.begin(9600);
}
void loop() {
if (Serial.available()) {
incomingByte = Serial.read();
if (incomingByte == 'W') {
digitalWrite(in1, HIGH);//adelante
digitalWrite(in4, HIGH);
digitalWrite(in2, LOW);
digitalWrite(in3, LOW);
}
if (incomingByte == 'S') {
digitalWrite(in1, LOW);//atras
digitalWrite(in4, LOW);
digitalWrite(in2, HIGH);
digitalWrite(in3, HIGH);
}
if (incomingByte == 'A') {
digitalWrite(in1, LOW);//der
digitalWrite(in4, HIGH);
digitalWrite(in2, HIGH);
digitalWrite(in3, LOW);
}
if (incomingByte == 'D') {
digitalWrite(in1, HIGH);//izq
digitalWrite(in4, LOW);
digitalWrite(in2,LOW );
digitalWrite(in3, HIGH);
}
if (incomingByte == 'E') {
digitalWrite(in1, LOW);//alto
digitalWrite(in4, LOW);
digitalWrite(in2, LOW);
digitalWrite(in3, LOW);
}
if (incomingByte == 'P') {
digitalWrite(en1, HIGH);//on
digitalWrite(en2, HIGH);
}
if (incomingByte == 'O') {
digitalWrite(en1, LOW);//off
digitalWrite(en2, LOW);
}
if (incomingByte == 'T') {
servo1.write(10); //1
delay(950);
}
if (incomingByte == 'Y') {
servo1.write(90); //1S
delay(950);
}
if (incomingByte == 'U') {
servo1.write(175); //1//////////////
delay(950);
}
if (incomingByte == 'H') {
servo2.write(90); //2
delay(950);
}
if (incomingByte == 'J') {
servo2.write(10); //2
delay(950);
}
if (incomingByte == 'V') {
servo3.write(90); //3
delay(950);
}
if (incomingByte == 'B') {
servo3.write(90); //3
delay(950);
}
if (incomingByte == 'N') {
servo3.write(170); //3
delay(950);
}
if (incomingByte == 'K') {
servo4.write(170); //4
delay(950);
}
if (incomingByte == 'L') {
servo4.write(95); //4
delay(950);
}
}
}
Comments