Professional Documents
Culture Documents
Grupo
Grupo
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);
// 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);
// 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);
// 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);
// 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);
// 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 (ENA, LOW);
digitalWrite (IN1, LOW);
digitalWrite (IN2, LOW);