const int pinMotorIzqRetro = 5;
const int pinMotorIzqAvance = 6;
const int pinMotorDerRetro = 3;
const int pinMotorDerAvance = 11;
void setup() {
pinMode(pinMotorIzqRetro, OUTPUT);
pinMode(pinMotorIzqAvance, OUTPUT);
pinMode(pinMotorDerRetro, OUTPUT);
pinMode(pinMotorDerAvance, OUTPUT);
}
void loop() {
avanza();
delay(500);
parar();
delay(500);
retro();
delay(500);
giroizquierda();
delay(500);
}
void retro(){
digitalWrite(pinMotorIzqAvance,HIGH);
digitalWrite(pinMotorDerAvance,LOW);
digitalWrite(pinMotorIzqRetro,LOW);
digitalWrite(pinMotorDerRetro,HIGH);
}
void parar(){
digitalWrite(pinMotorIzqAvance,LOW);
digitalWrite(pinMotorDerAvance,LOW);
digitalWrite(pinMotorIzqRetro,LOW);
digitalWrite(pinMotorDerRetro,LOW);
}
void avanza(){
digitalWrite(pinMotorIzqAvance,LOW);
digitalWrite(pinMotorDerAvance,HIGH);
digitalWrite(pinMotorIzqRetro,HIGH);
digitalWrite(pinMotorDerRetro,LOW);
}
void giroizquierda(){
digitalWrite(pinMotorIzqAvance,LOW);
digitalWrite(pinMotorDerAvance,LOW);
digitalWrite(pinMotorIzqRetro,HIGH);
digitalWrite(pinMotorDerRetro,HIGH);
}
void giroderecha(){
digitalWrite(pinMotorIzqAvance,HIGH);
digitalWrite(pinMotorDerAvance,HIGH);
digitalWrite(pinMotorIzqRetro,LOW);
digitalWrite(pinMotorDerRetro,LOW);
}
Comentarios
Publicar un comentario