//Ejemplo de if anidado - robot seguidor de línea
//Definición de variables
#define motorIzq 2
#define motorDer 5
int sensorA, sensorB;
void setup() {
// Acuerdo de velocidad
Serial.begin(115200);
Serial.println("Robot seguidor de línea");
//Configuración de GPIOS
pinMode(motorIzq, OUTPUT);
pinMode(motorDer, OUTPUT);
}
void loop() {
//Ingrese el valor del sensor A
sensorA = 15;
//Ingrese el valor del sensor B
sensorB = 14;
// Si (A > B) entonces
if (sensorA > sensorB) {
Serial.println("A > B");
digitalWrite(motorDer, HIGH); //Movemos rueda derecha
digitalWrite(motorIzq, LOW); //Apagamos rueda izquierda
} //Si no
else {
//Si (A < B) entonces
if (sensorA < sensorB) {
Serial.println("A < B");
digitalWrite(motorDer, LOW); //Apagamos rueda derecha
digitalWrite(motorIzq, HIGH); //Movemos rueda izquierda
}// Si no
else {
Serial.println("A = B");
digitalWrite(motorDer, HIGH); //Movemos rueda derecha
digitalWrite(motorIzq, HIGH); //Movemos rueda izquierda
}
}
}