#define LED0 D2
#define LED1 D3
#define LED2 D4
#define LED3 D5

// Buffer para recepción de comandos
const byte TAM_BUFFER = 20;
char buffer[TAM_BUFFER];
String comandoRecibido = "";
String ultimoEstadoValido = "";

// Temporización
unsigned long Millis_Anterior = 0;
const unsigned long interval = 10;

void setup() {
  pinMode(LED0, OUTPUT);
  pinMode(LED1, OUTPUT);
  pinMode(LED2, OUTPUT);
  pinMode(LED3, OUTPUT);
  Serial.begin(115200);
  resetLEDs();
  Serial.println("Sistema iniciado. Envie 'adelante' o 'atras'...");
}

void loop() {
  unsigned long Millis_Actual = millis();
  
  if (Millis_Actual - Millis_Anterior >= interval) {
    Millis_Anterior = Millis_Actual;
    
    if (Serial.available() > 0) {
      // Limpiar buffer y variables
      memset(buffer, 0, TAM_BUFFER); //función de la biblioteca estándar de C (<string.h>) que se utiliza para llenar un bloque de memoria con un valor específico.
      comandoRecibido = "";
      
      // Leer datos disponibles
      size_t bytesLeidos = Serial.readBytesUntil('\n', buffer, TAM_BUFFER-1);
      
      if (bytesLeidos > 0) {
        procesarComando(buffer);
      }
    }
  }
}

void procesarComando(char* datos) {
  comandoRecibido = String(datos);
  comandoRecibido.toLowerCase();
  comandoRecibido.trim(); //método de la clase String en Arduino que se utiliza para eliminar espacios en blanco y otros caracteres de control del inicio y final de una cadena de texto.
  
  if (comandoRecibido == "adelante") {
    Serial.println("Modo: Adelante");
    digitalWrite(LED0, HIGH);
    digitalWrite(LED1, LOW);
    digitalWrite(LED2, LOW);
    digitalWrite(LED3, HIGH);
    ultimoEstadoValido = "adelante";
  } 
  else if (comandoRecibido == "atras") {
    Serial.println("Modo: Atras");
    digitalWrite(LED0, LOW);
    digitalWrite(LED1, HIGH);
    digitalWrite(LED2, HIGH);
    digitalWrite(LED3, LOW);
    ultimoEstadoValido = "atras";
  }
  else if (ultimoEstadoValido == "") {
    resetLEDs();
  }
}

void resetLEDs() {
  digitalWrite(LED0, LOW);
  digitalWrite(LED1, LOW);
  digitalWrite(LED2, LOW);
  digitalWrite(LED3, LOW);
}