#include<Servo.h>
#include <SoftwareSerial.h>
#include <BlynkSimpleSerialBLE.h>
int vel=0;
int velcontador=0;
int r=0;
int g=0;
int b=0;

SoftwareSerial SwSerial(2, 3); // RX, TX 
char auth[] = "2a4da3a232764a6a87368d9735aede6e";

SoftwareSerial SerialBLE(2, 3); // RX, TX
BlynkTimer timer;

BLYNK_WRITE(V1)
{
  vel=param.asInt();
}

BLYNK_WRITE(V4)
{
    r = param[0].asInt();
    g = param[1].asInt();
    b = param[2].asInt();
}

void contadorvelocidad(){
  Blynk.virtualWrite(V2, velcontador);
}

Servo ESC;
Servo ESC2;
 
void setup()
{
  SerialBLE.begin(9600);
  //Serial.begin(9600);
  Blynk.begin(SerialBLE, auth);
  Serial.println("Waiting for connections...");
  //Asignar un pin a los ESCs
  ESC.attach(5);
  ESC.writeMicroseconds(1000);
  ESC2.attach(6);
  ESC2.writeMicroseconds(1000);
  delay(5000);
  timer.setInterval(100L, contadorvelocidad);
  pinMode(11,OUTPUT);
  pinMode(10,OUTPUT);
  pinMode(9,OUTPUT);
}
 
 
void loop()
{
  Blynk.run();
  timer.run();
    if(vel != 0)
    {
      ESC.writeMicroseconds(vel); //Generar un pulso con el numero recibido
      ESC2.writeMicroseconds(vel);
    }
    velcontador=map(vel,1000,2000,0,100);
    analogWrite(11,r);
    analogWrite(10,g);
    analogWrite(9,b);
  }