22/07/2019
//programacion ECO
int a = 14;
int b = 15;
int c = 7;
int d = 8;
int ENB = 5;
int ENA = 6;
int state = 0; // Variable lectrura serial
Servo servo; //Creamos un objeto Servo de nombre... servo
void setup() {
pinMode(a, OUTPUT); //Declara pin de Salida
pinMode(b, OUTPUT); //Declara pin de Salida
pinMode(c, OUTPUT); //Declara pin de Salida
pinMode(d, OUTPUT); //Declara pin de Salida
pinMode(ENB, OUTPUT); //Declara pin de Salida
pinMode(ENA, OUTPUT); //Declara pin de Salida
digitalWrite(a, LOW); //Normalmente Apagado
digitalWrite(b, LOW); //Normalmente Apagado
digitalWrite(c, LOW); //Normalmente Apagado
digitalWrite(d, LOW); //Normalmente Apagado
// Configuramos el puerto serial a 9600 bps
Serial.begin(9600);
servo.attach(17); //Conectamos el servo al pin digital 3
}
void loop() {
//si el modulo a manda dato, guardarlo en estado.
if(Serial.available() > 0){
state = Serial.read();
} // esta parte del código es para solo 1 Carácter o Unidad.
// si el estado es 0 ese sería Apagado “OFF”
if (state == '1') {
digitalWrite(a, LOW);
digitalWrite(b, LOW); //Normalmente Apagado
digitalWrite(c, LOW); //Normalmente Apagado
digitalWrite(d, LOW); //Normalmente Apagado
analogWrite(ENB,255);
analogWrite(ENA,255);
Serial.println("PARO");
}
if (state == 'w') {
digitalWrite(a, LOW);
digitalWrite(b, HIGH); //Normalmente Apagado
// digitalWrite(c, HIGH); //Normalmente Apagado
//digitalWrite(d, LOW); //Normalmente Apagado
//analogWrite(ENB,255);
//analogWrite(ENA,255);
Serial.println("adelante");
}
if (state == 's') {
digitalWrite(a, HIGH);
digitalWrite(b, LOW); //Normalmente Apagado
//digitalWrite(c, LOW); //Normalmente Apagado
//digitalWrite(d, HIGH); //Normalmente Apagado
//analogWrite(ENB,255);
//analogWrite(ENA,255);
Serial.println("Atras");
}
if (state == 'q') {
servo.write(33); //Mueve el servo a la posición entrada (excepto si es 0)
Serial.println("izquierda");
}
if (state == '2') {
servo.write(80); //Mueve el servo a la posición entrada (excepto si es 0)
Serial.println("frente");
}
if (state == 'e') {
servo.write(127); //Mueve el servo a la posición entrada (excepto si es 0)
Serial.println("derecha");
}
}
