#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 BT;

void setup() {
BT.begin(9600);
Serial.begin(9600);//habilitar monitor serie

//motor izquierdo//
pinMode(12,OUTPUT);
pinMode(13,OUTPUT);

//motor derecho//
pinMode(2,OUTPUT);
pinMode(4,OUTPUT);

//motor con cepillo//
pinMode(23,OUTPUT);
}

void adelante(){
//motor izquiero adelante//
digitalWrite(12, HIGH);
digitalWrite(13, LOW);
//motor derecho adelante//
digitalWrite(2,HIGH);
digitalWrite(4, LOW);
}

void retroceder(){
//motor izquiero retroceder//
digitalWrite(12, LOW);
digitalWrite(13, HIGH);
//motor derecho  retroceder//
digitalWrite(2,LOW);
digitalWrite(4,HIGH);
}

void derecha(){
//motor izquiero adelante//
digitalWrite(12, HIGH);
digitalWrite(13, LOW);
//motor derecho  retroceder//
digitalWrite(2,LOW);
digitalWrite(4,HIGH); 
}

void izquierda(){
//motor izquiero retrocede//
digitalWrite(12, LOW);
digitalWrite(13, HIGH);
//motor derecho  adelante//
digitalWrite(2,HIGH);
digitalWrite(4,LOW); 
}

void detener(){
//motor izquiero apagado//
digitalWrite(12, LOW);
digitalWrite(13, LOW);
//motor derecho  apagado//
digitalWrite(2,LOW);
digitalWrite(4,LOW); 
}

void loop() {
if(BT.available()){
 char mensaje = BT.read();
  
  if(mensaje == 'F'){
      adelante();
  }
  
  if(mensaje == 'B'){
      retroceder();
  }

  if(mensaje == 'R'){
      derecha();
  }

  if(mensaje == 'L'){
      izquierda();
  }

  if(mensaje == 'T'){
      detener();
  }

  ///////activación del motor con cepillo/////
  if(mensaje == 'C'){
      digitalWrite(23, HIGH);
  }
   if(mensaje == 'Q'){
      digitalWrite(23, LOW);
  }


}
}