#include <Arduino.h>

char command; // Variable para almacenar el comando recibido

// Define los pines de control para los motores
int motorA1 = 2;
int motorA2 = 3;
int motorB1 = 4;
int motorB2 = 5;

void setup() {
  Serial.begin(115200);
  // Configura los pines de salida para controlar los motores aquí
  pinMode(motorA1, OUTPUT);
  pinMode(motorA2, OUTPUT);
  pinMode(motorB1, OUTPUT);
  pinMode(motorB2, OUTPUT);
}

void loop() {
  if (Serial.available() > 0) {
    command = Serial.read();

    // Realiza la acción correspondiente al comando recibido
    switch (command) {
      case '31':
        // Avanzar: Controla los motores para avanzar
        digitalWrite(motorA1, HIGH);
        digitalWrite(motorA2, LOW);
        digitalWrite(motorB1, HIGH);
        digitalWrite(motorB2, LOW);
        break;
      case '32':
        // Retroceder: Controla los motores para retroceder
        digitalWrite(motorA1, LOW);
        digitalWrite(motorA2, HIGH);
        digitalWrite(motorB1, LOW);
        digitalWrite(motorB2, HIGH);
        break;
      case '33':
        // Izquierda: Controla los motores para girar a la izquierda
        digitalWrite(motorA1, HIGH);
        digitalWrite(motorA2, LOW);
        digitalWrite(motorB1, LOW);
        digitalWrite(motorB2, HIGH);
        break;
      case '34':
        // Derecha: Controla los motores para girar a la derecha
        digitalWrite(motorA1, LOW);
        digitalWrite(motorA2, HIGH);
        digitalWrite(motorB1, HIGH);
        digitalWrite(motorB2, LOW);
        break;
      case '35':
        // Detener: Detiene todos los motores
        digitalWrite(motorA1, LOW);
        digitalWrite(motorA2, LOW);
        digitalWrite(motorB1, LOW);
        digitalWrite(motorB2, LOW);
        break;
      default:
        // Comando no reconocido
        break;
    }
  }
}