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

Entradas más populares de este blog