// Definición de los pines para las "ruedas" (LEDs)
const int LED_FRONT_IZQ = 12; // Rojo
const int LED_FRONT_DER = 14; // Rojo
const int LED_TRAS_IZQ  = 26; // Azul
const int LED_TRAS_DER  = 27; // Azul

// Definición del pin para el control (Slide Switch)
const int SW_MARCHA = 34; // Central del switch

void setup() {
  // Configurar los pines de los LEDs como SALIDA
  pinMode(LED_FRONT_IZQ, OUTPUT);
  pinMode(LED_FRONT_DER, OUTPUT);
  pinMode(LED_TRAS_IZQ, OUTPUT);
  pinMode(LED_TRAS_DER, OUTPUT);
  
  // Configurar el pin del switch como ENTRADA
  pinMode(SW_MARCHA, INPUT);
  
  Serial.begin(115200);
  Serial.println("Simulador de Robot Carro listo.");
}

void loop() {
  // Leer el estado del switch (HIGH/LOW)
  if (digitalRead(SW_MARCHA) == HIGH) {
    // Si el switch está en ON (activo), encendemos las 4 ruedas
    digitalWrite(LED_FRONT_IZQ, HIGH);
    digitalWrite(LED_FRONT_DER, HIGH);
    digitalWrite(LED_TRAS_IZQ, HIGH);
    digitalWrite(LED_TRAS_DER, HIGH);
    Serial.println("Avanzando: 4 Ruedas ACTIVAS");
  } else {
    // Si el switch está en OFF (apagado), detenemos las ruedas
    digitalWrite(LED_FRONT_IZQ, LOW);
    digitalWrite(LED_FRONT_DER, LOW);
    digitalWrite(LED_TRAS_IZQ, LOW);
    digitalWrite(LED_TRAS_DER, LOW);
    Serial.println("Detenido: 4 Ruedas OFF");
  }
  
  delay(100); // Pequeña espera para no saturar el simulador
}