You are on page 1of 3

int IN1 = 2;

int IN2 = 3;
int ENA = 5;
int IN3 = 7;
int IN4 = 8;
int ENB = 9;

void setup() {
pinMode (IN1, OUTPUT); // Retroceder
pinMode (IN2, OUTPUT); // Avanzar
pinMode (ENA, OUTPUT); // Rueda Dcha
pinMode (IN3, OUTPUT); // retrocede
pinMode (IN4, OUTPUT); // avanza
pinMode (ENB, OUTPUT); // Rueda izq
}

void loop() {
// Giro
digitalWrite (ENA, HIGH);
digitalWrite (IN1, LOW);
digitalWrite (IN2, HIGH);

digitalWrite (ENB, HIGH);


digitalWrite (IN3, LOW);
digitalWrite (IN4, HIGH);
delay(14000);

digitalWrite (ENA, LOW);


digitalWrite (ENB, LOW);
delay(1000);

// Giro
digitalWrite (ENB, LOW);
digitalWrite (ENA, HIGH);
digitalWrite (IN4, LOW);
digitalWrite (IN3, HIGH);
delay(750);

// 3m
digitalWrite (ENA, HIGH);
digitalWrite (IN1, LOW);
digitalWrite (IN2, HIGH);

digitalWrite (ENB, HIGH);


digitalWrite (IN3, LOW);
digitalWrite (IN4, HIGH);
delay(7000);

// Giro Derecha
digitalWrite (ENB, LOW);
digitalWrite (ENA, HIGH);
digitalWrite (IN4, LOW);
digitalWrite (IN3, HIGH);
delay(900);

// 2,5 m
digitalWrite (ENA, HIGH);
digitalWrite (IN1, LOW);
digitalWrite (IN2, HIGH);
digitalWrite (ENB, HIGH);
digitalWrite (IN3, LOW);
digitalWrite (IN4, HIGH);
delay(5000);

// Giro Derecha
digitalWrite (ENB, LOW);
digitalWrite (ENA, HIGH);
digitalWrite (IN4, LOW);
digitalWrite (IN3, HIGH);
delay(700);

// 2,2m
digitalWrite (ENA, HIGH);
digitalWrite (IN1, LOW);
digitalWrite (IN2, HIGH);

digitalWrite (ENB, HIGH);


digitalWrite (IN3, LOW);
digitalWrite (IN4, HIGH);
delay(4900);

// Giro izquierda
digitalWrite (ENA, LOW);
digitalWrite (ENB, HIGH);
digitalWrite (IN4, HIGH);
digitalWrite (IN3, LOW);
delay(900);

// 1,6 m
digitalWrite (ENA, HIGH);
digitalWrite (IN1, LOW);
digitalWrite (IN2, HIGH);

digitalWrite (ENB, HIGH);


digitalWrite (IN3, LOW);
digitalWrite (IN4, HIGH);
delay(2800);

// Giro Izquierda
digitalWrite (ENA, LOW);
digitalWrite (ENA, HIGH);
digitalWrite (IN4, HIGH);
digitalWrite (IN3, LOW);
delay(900);

// 4m
digitalWrite (ENA, HIGH);
digitalWrite (IN1, LOW);
digitalWrite (IN2, HIGH);

digitalWrite (ENB, HIGH);


digitalWrite (IN3, LOW);
digitalWrite (IN4, HIGH);
delay(8000);

// Giro Izquierda
digitalWrite (ENA, LOW);
digitalWrite (ENB, HIGH);
digitalWrite (IN4, HIGH);
digitalWrite (IN3, LOW);
delay(900);

// 3.8 M
digitalWrite (ENA, HIGH);
digitalWrite (IN1, LOW);
digitalWrite (IN2, HIGH);

digitalWrite (ENB, HIGH);


digitalWrite (IN3, LOW);
digitalWrite (IN4, HIGH);
delay(6800);

//
digitalWrite (ENA, LOW);
digitalWrite (IN1, LOW);
digitalWrite (IN2, LOW);

digitalWrite (ENB, LOW);


digitalWrite (IN3, LOW);
digitalWrite (IN4, LOW);
delay(6800);

You might also like