// Definición de pines para los sensores
const int sensorIzquierdo = 2;
const int sensorDerecho = 3;
// Definición de pines para los motores
const int motorIzquierdo = 4;
const int motorDerecho = 5;
void setup() {
// Configura los pines de los sensores como entradas
pinMode(sensorIzquierdo, INPUT);
pinMode(sensorDerecho, INPUT);
// Configura los pines de los motores como salidas
pinMode(motorIzquierdo, OUTPUT);
pinMode(motorDerecho, OUTPUT);
}
void loop() {
Serial.println("Area Scanning");
int lecturaIzquierda = digitalRead(sensorIzquierdo);
int lecturaDerecha = digitalRead(sensorDerecho);
Serial.println("Izq: " + lecturaIzquierda + " - Der: " + lecturaDerecha);
if (lecturaIzquierda == LOW && lecturaDerecha == LOW) {
// Ambos sensores detectan la línea, avanza recto
digitalWrite(motorIzquierdo, HIGH);
digitalWrite(motorDerecho, HIGH);
} else if (lecturaIzquierda == HIGH && lecturaDerecha == LOW) {
// Gira a la derecha
digitalWrite(motorIzquierdo, LOW);
digitalWrite(motorDerecho, HIGH);
} else if (lecturaIzquierda == LOW && lecturaDerecha == HIGH) {
// Gira a la izquierda
digitalWrite(motorIzquierdo, HIGH);
digitalWrite(motorDerecho, LOW);
} else {
// Ambos sensores están fuera de la línea, detén el robot
digitalWrite(motorIzquierdo, LOW);
digitalWrite(motorDerecho, LOW);
}
}