Comunicacion Serial

// Buffer para guardar el comando
String comandoBuffer = "";

void setup() {
  Serial.begin(9600);  // Iniciar comunicacion

  pinMode(LED_BUILTIN, OUTPUT);

  Serial.println("EigenRobotics - Control Serial");
  Serial.println("Escribe HELP para ver comandos");
}

void loop() {
  // Mientras haya datos esperando...
  while (Serial.available() > 0) {
    char c = Serial.read();  // Lee UN caracter

    if (c == '\n' || c == '\r') {
      // Es un ENTER! Procesar comando
      if (comandoBuffer.length() > 0) {
        procesarComando(comandoBuffer);
        comandoBuffer = "";  // Limpiar para el siguiente
      }
    } else {
      // Agregar letra al buffer
      comandoBuffer += c;
    }
  }
}

void procesarComando(String cmd) {
  cmd.trim();           // Quitar espacios
  cmd.toUpperCase();    // Todo a mayusculas

  Serial.print("> ");
  Serial.println(cmd);  // Echo del comando

  // Comparar con comandos conocidos
  if (cmd == "LED_ON") {
    digitalWrite(LED_BUILTIN, HIGH);
    Serial.println("LED encendido");
  }
  else if (cmd == "LED_OFF") {
    digitalWrite(LED_BUILTIN, LOW);
    Serial.println("LED apagado");
  }
  else if (cmd.startsWith("BLINK:")) {
    int veces = cmd.substring(6).toInt();
    parpadear(veces);
  }
  else {
    Serial.println("Comando no reconocido");
  }
}