#include "BluetoothSerial.h"

#if !defined(CONFIG_BT_ENABLED) || !defined(CONFIG_BLUEDROID_ENABLED)
#error Bluetooth is not enabled! Please run `make menuconfig` to and enable it
#endif

BluetoothSerial SerialBT;

void setup() {
  // put your setup code here, to run once:
  Serial.begin(115200);
  SerialBT.begin("ESP32test");
  Serial.println("Hello, ESP32!");
  pinMode(2,OUTPUT);
  pinMode(4,OUTPUT);
  pinMode(19, OUTPUT);
  pinMode(12,OUTPUT);
  pinMode(14,OUTPUT);
  pinMode(32, OUTPUT);
}

void detenido() {
  //motor derecho avanza
digitalWrite(2, LOW);
digitalWrite(4, LOW);
analogWrite(19,255);

//motor izquierdo avanza
digitalWrite(12, LOW);
digitalWrite(14, LOW);
analogWrite(32,255);
}

void adelante() {
  //motor derecho avanza
digitalWrite(2, HIGH);
digitalWrite(4, LOW);
analogWrite(19,155);

//motor izquierdo avanza
digitalWrite(12, HIGH);
digitalWrite(14, LOW);
analogWrite(32,155);
}

void retroceder(){
//motor derecho retrocede
digitalWrite(2, LOW);
digitalWrite(4, HIGH);
analogWrite(19,155);

//motor izquierdo retrocede
digitalWrite(12, LOW);
digitalWrite(14, HIGH);
analogWrite(32,155);
}

void derecha(){
//motor derecho retrocede
digitalWrite(2, LOW);
digitalWrite(4, HIGH);
analogWrite(19,155);

//motor izquierdo avanza
digitalWrite(12, HIGH);
digitalWrite(14, LOW);
analogWrite(32,155);
}

void izquierda(){
//motor derecho avanza
digitalWrite(2, HIGH);
digitalWrite(4, LOW);
analogWrite(19,155);

//motor izquierdo retrocede
digitalWrite(12, LOW);
digitalWrite(14, HIGH);
analogWrite(32,155);
}



void loop() {
if (SerialBT.available()) {
  char Mensaje = SerialBT.read();
  Serial.println(Mensaje);

if(Mensaje == 'F' ){
    adelante();
    Serial.println("ADELANTE");
}

if( Mensaje == 'B'  ){
    retroceder();
    Serial.println("RETROCEDER");
}

if(Mensaje == 'L'  ){
    izquierda();
    Serial.println("IZQUIERDA");
}

if(Mensaje == 'R'  ){
    derecha();
    Serial.println("DERECHA");
}
if(Mensaje == 'C'  ){
    detenido();
    Serial.println("DETENIDO");
}

delay(10);

}
 // this speeds up the simulation
}