Paso 4: El Codigo
El código fue descargado de internet y modificado por mí.
Código:
izqA int = 6;
izqB int = 5;
int EB = 7;
derA de int = 8;
derB int = 9;
int EA = 10;
vel de int = 255; 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, salida);
pinMode (derB, salida);
pinMode (izqA, salida);
pinMode (izqB, salida);
pinMode (EA, salida);
pinMode (EB, salida);
Delay(100);
digitalWrite (EA, alto);
digitalWrite (EB, alto);
}
void loop() {}
if(serial.Available() > 0) {/ / lee el bluetooth y almacena en estado
Estado = Serial.read();
}
if(estado=='a') {/ / Boton desplazar al Frente
analogWrite (derB, 0);
analogWrite (izqB, 0);
analogWrite (derA, vel);
analogWrite (izqA, vel);
}
if(estado=='b') {/ / Boton IZQ
analogWrite (derB, 0);
analogWrite (izqB, 0);
analogWrite (derA, vel);
analogWrite (izqA, 0);
}
if(estado=='c') {/ / Boton Parar
analogWrite (derB, 0);
analogWrite (izqB, 0);
analogWrite (derA, 0);
analogWrite (izqA, 0);
}
if(estado=='d') {/ / Boton DER
analogWrite (derB, 0);
analogWrite (izqB, 0);
analogWrite (izqA, vel);
analogWrite (derA, 0);
}
if(estado=='e') {/ / Boton atrás
analogWrite (derB, vel);
analogWrite (izqB, vel);
analogWrite (derA, 0);
analogWrite (izqA, 0);
}
Si (estado == 'f') {/ / Boton encendido Dispara
}
}