Stap 4: El Codigo
El código fue descargado de internet y modificado por mí.
Código:
int izqA = 6;
int izqB = 5;
int EB = 7;
int derA = 8;
int derB = 9;
int EA = 10;
int vel = 255; Velocidad de los motores (0-255)
int estado = 'g'; inicia detenido
VOID Setup {}
Serial.begin(9600); inicia el puerto seriële para comunicacion con el Bluetooth
pinMode (derA, OUTPUT);
pinMode (derB, OUTPUT);
pinMode (izqA, OUTPUT);
pinMode (izqB, OUTPUT);
pinMode (EA, uitvoer);
pinMode (EB, uitvoer);
delay(100);
digitalWrite (EA, hoge);
digitalWrite (EB, hoge);
}
void loop {}
if(Serial.available() > 0) {/ / lee el bluetooth y almacena nl 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 Reverse
analogWrite (derB, vel);
analogWrite (izqB, vel);
analogWrite (derA, 0);
analogWrite (izqA, 0);
}
Als (estado == 'f') {/ / Boton ON Dispara
}
}