CARRO BLUETOOH LIMPIADOR

Los siguientes números indican el pin al que se debe colocar los motores
int izqA = 5; //Motor izquierdo
int izqB = 6; //Motor izquierdo
int derA = 9; //Motor derecho
int derB = 10; //Motor derecho
int rotA = 11; //Motor limpiador
int rotB = 12; //Motor limpiador
int vel = 50; // Velocidad de los motores (0-255)
int estado = 'g'; // inicia detenido

void setup() {
Serial.begin(9600); // inicia el puerto serial para comunicacion con el Bluetooth
pinMode(derA, OUTPUT);
pinMode(derB, OUTPUT);
pinMode(izqA, OUTPUT);
pinMode(izqB, OUTPUT);
pinMode(rotA, OUTPUT);
pinMode(rotB, OUTPUT);
}

void loop() {

if(Serial.available()>0){ // lee el bluetooth y almacena en estado

estado = Serial.read();
}
if(estado=='a'){ // Boton desplazar al Frente
digitalWrite(derB, LOW);
digitalWrite(izqB, LOW);
digitalWrite(derA, 50);
digitalWrite(izqA, 50);
digitalWrite(rotA, LOW);
digitalWrite(rotB, LOW);
}
if(estado=='b'){ // Boton IZQ
digitalWrite(derB, LOW);
digitalWrite(izqB, LOW);
digitalWrite(derA, LOW);
digitalWrite(izqA, 50);
digitalWrite(rotA, LOW);
digitalWrite(rotB, LOW);
}
if(estado=='c'){ // Boton Parar
digitalWrite(derB, LOW);
digitalWrite(izqB, LOW);
digitalWrite(derA, LOW);
digitalWrite(izqA, LOW);
digitalWrite(rotA, LOW);
digitalWrite(rotB, LOW);
}
if(estado=='d'){ // Boton DER
digitalWrite(derB, LOW);
 digitalWrite(izqB, LOW);
digitalWrite(izqA, LOW);
digitalWrite(derA, 50);
digitalWrite(rotA, LOW);
digitalWrite(rotB, LOW);
}

if(estado=='e'){ // Boton Reversa

digitalWrite(derA, LOW);
digitalWrite(izqA, LOW);
digitalWrite(derB, 50);
digitalWrite(izqB, 50);
digitalWrite(rotA, LOW);
digitalWrite(rotB, LOW);
}

if(estado=='f'){ // Boton ON, enciende al rotor

digitalWrite(derA, LOW);
digitalWrite(izqA, LOW);
digitalWrite(derB, LOW);
digitalWrite(izqB, LOW);
digitalWrite(rotA, 50);
digitalWrite(rotB, LOW);
}

if(estado=='g'){ // Boton OFF, detiene al rotor

digitalWrite(derA, LOW);
digitalWrite(izqA, LOW);
digitalWrite(derB, LOW);
digitalWrite(izqB, LOW);
digitalWrite(rotA, LOW);
digitalWrite(rotB, LOW);
}

if (estado =='x'){ // Boton ON se mueve sensando distancia

}
if (estado=='z'){ // Boton OFF, detiene los motores no hace nada
}
}