/*****DECLARACIONES******/
#define VERSION     "\n\nInnobot App V1.0.0 BASIC" //Declaración de variable opcional con la versión del código
#define    ledPin       13 //Declaración del pin 13 como LED de prueba


/*****CONFIGURACIONES******/
void setup()  {

  motorSpeed(M1 , 80); //Configuración del motor M1 a 80% de su velocidad
  motorSpeed(M2 , 80); //Configuración del motor M2 a 80% de su velocidad
  motorSpeed(M3 , 80); //Configuración del motor M3 a 80% de su velocidad

  Serial.begin(9600); //Fijar la velocidad en baudios para la transmisión de datos en serie. 
  Serial1.begin(9600); //Fijar la velocidad en baudios para la transmisión de datos en serie. 

  pinMode(ledPin, OUTPUT); //Configurar el pin 13 de salida 
  
  Serial.println(VERSION); //Imprimir la versión del programa en consola
}

/*****CICLO INFINITO******/
void loop() {
  if (Serial1.available())  { //Si hay datos disponibles en el serial
    delay(2); //Esperar 2 milisegundos
    int s = Serial1.read(); //Guardar el dato de entrada del serial en una variable s.
    Serial.print("El comando enviado es: "); //Imprimir en el monitor
    Serial.println(s); //Imprimir en el monitor el comando enviado desde la App.
    getButtonState(s); //Enviar dato s a la función getButtonState(s) y ejecutarla.
  }
}

/**FUNCIÓN DE ESTADOS DE BOTONES**/
void getButtonState(int bStatus)  {
  
  // -----------------  BOTÓN #1 - AZUL  -----------------------
  if (bStatus == 'A') { //Si el valor recibido corresponde a 'A' o lo que es lo mismo 65 en entero
    Serial.println("** Button_1_BLUE: ON **"); //Imprimir el estado del botón en consola
    // Acá se escriben las instrucciones que se desean realizar al presionar el botón...
    digitalWrite(ledPin, HIGH); //Encender LED del pin 13
    myTone(La5 , blanca); //Sonar una nota La5 durante una blanca 
    myTone(Fa5 , blanca); //Sonar una nota Fa5 durante una blanca
  } 
  // -----------------  BOTÓN #2 - ROJO  -----------------------
  else if (bStatus == 'B') { //Sino si el valor recibido corresponde a 'B' o lo que es lo mismo 66 en entero
    Serial.println("** Button_2_RED: ON **"); //Imprimir el estado del botón en consola
    // Acá se escriben las instrucciones que se desean realizar al presionar el botón...
    digitalWrite(ledPin, HIGH); //Encender LED del pin 13
    motorOn(M3, FORWARD); //Encender motor M3 hacia adelante
    delay(20); //Esperar 20 milisegundos
  } 
  // -----------------  BOTÓN #3 - AMARILLO  -----------------------
  else if (bStatus == 'C') {
    Serial.println("** Button_3_YELLOW: ON **");
    // Acá se escriben las instrucciones que se desean realizar al presionar el botón...
    digitalWrite(ledPin, HIGH);
    myTone(Si5 , blanca);
    myTone(Do5 , blanca);
  } 
  // -----------------  BOTÓN #4 - VERDE  -----------------------
  else if (bStatus == 'D') {
    Serial.println("** Button_4_GREEN: ON **");
    // Acá se escriben las instrucciones que se desean realizar al presionar el botón...
    digitalWrite(ledPin, HIGH);
    motorOn(M3, REVERSE);
    delay(20);
  } 
  // -----------------  BOTÓN #5 - ARRIBA  -----------------------
  else if (bStatus == 'E') {
    Serial.println("** Button_5_UP: ON**");
    // Acá se escriben las instrucciones que se desean realizar al presionar el botón...
    digitalWrite(ledPin, HIGH);
    goForward(M1 , M2);
  } 
  // -----------------  BOTÓN #6 - DERECHA  -----------------------
  else if (bStatus == 'F') {
    Serial.println("** Button_6_RIGHT: ON **");
    // Acá se escriben las instrucciones que se desean realizar al presionar el botón...
    digitalWrite(ledPin, HIGH);
    turnRight(M2 , M1);
  } 
  // -----------------  BOTÓN #7 - ABAJO  -----------------------
  else if (bStatus == 'G') {
    Serial.println("** Button_7_DOWN: ON **");
    // Acá se escriben las instrucciones que se desean realizar al presionar el botón...
    digitalWrite(ledPin, HIGH);
    goReverse(M1 , M2);
  } 
  // -----------------  BOTÓN #8 - IZQUIERDA  -----------------------
  else if (bStatus == 'H') {
    Serial.println("** Button_8_LEFT: ON **");
    // Acá se escriben las instrucciones que se desean realizar al presionar el botón...
    digitalWrite(ledPin, HIGH);
    turnLeft(M2 , M1);
  } 
  // -----------------  NINGÚN CASO ANTERIOR  -----------------------
  else { //Sino se cumplen ninguno de los casos anteriores entonces:
    Serial.println();
    motorsOff(M1 , M2); //Apagar motores M1 M2
    motorOff(M3); //Apagar motor M3
    digitalWrite(ledPin, LOW); //Apagar LED
    noTone(8); //Silenciar el Innobot
  }
}