int izqA = 4;
int izqB = 7;
int derA = 5;
int derB = 6;
int vel = 255; // Velocidad de los motores (0-255)
void setup() {
pinMode(derA, OUTPUT);
pinMode(derB, OUTPUT);
pinMode(izqA, OUTPUT);
pinMode(izqB, OUTPUT);
}
void loop() {
analogWrite(derB, 0); // Detiene los Motores
analogWrite(izqB, 0);
delay (500);
analogWrite(derA, vel); // Frente 2 segundos
analogWrite(izqA, vel);
delay (2000);
analogWrite(derA, vel); // Derecha 0,5 segundos
analogWrite(izqA, 0);
delay (500);
analogWrite(derA, 0); // Izquierda 0,5 segundos
analogWrite(izqA, vel);
delay (500);
analogWrite(derA, 0); // Detiene los Motores
analogWrite(izqA, 0);
delay (500);
analogWrite(derB, vel); // Reversa 2 segundos
analogWrite(izqB, vel);
delay (2000);
}
No hay comentarios:
Publicar un comentario