#define LED_BUILTIN 2
#include <BLEDevice.h>
#include <BLEServer.h>
#include <BLEUtils.h>
#include <BLE2902.h>

#define temperatureCelsius
#define BLE_server "ESP32_Server"

#define SERVICE_UUID "huecat23-6d3c-4a17-a71f-ece2e6075f9b"

BLECharacteristic dhtTemperatureCelsiusCharacteristics("huecat23-c85e-4596-9bd9-015e2eaa4888", BLECharacteristic::PROPERTY_NOTIFY);
BLEDescriptor dhtTemperatureCelsiusDescriptor(BLEUUID((uint16_t)0x2902));

BLECharacteristic dhtHumidityCharacteristics("huecat23-4a2f-4cf3-96e6-38b79be71a61", BLECharacteristic::PROPERTY_NOTIFY);
BLEDescriptor dhtHumidityDescriptor(BLEUUID((uint16_t)0x2903));


bool device_connected = false;

class MyServerCallbacks: public BLEServerCallbacks {
    void onConnect(BLEServer* pServer) {
      device_connected = true;
    };

    void onDisconnect(BLEServer* pServer) {
      device_connected = false;
    }
};

void setup() {

  Serial.begin(115200);

  BLEDevice::init(BLE_server);
  BLEServer *pServer = BLEDevice::createServer();
  pServer->setCallbacks(new MyServerCallbacks());
  BLEService *dhtService = pServer->createService(SERVICE_UUID);


  dhtService->addCharacteristic(&dhtTemperatureCelsiusCharacteristics);
  dhtTemperatureCelsiusDescriptor.setValue("DHT Temperature (Celsius)");
  dhtTemperatureCelsiusCharacteristics.addDescriptor(new BLE2902());

  dhtService->addCharacteristic(&dhtHumidityCharacteristics);
  dhtHumidityDescriptor.setValue("DHT humidity");
  dhtHumidityCharacteristics.addDescriptor(new BLE2902());
  dhtService->start();
  pServer->getAdvertising()->start();
  Serial.println("Esperando a Cliente Bluetooth");
}
void loop() {


  //Timer cada 5 segundos: envía la info por bluetooth
  static unsigned long enviaDato;
  if (millis() > enviaDato + 5000) {
    enviaDato = millis();

    ///////////////////////////////// 
      if (device_connected) {

    //Datos de prueba
    float temp = 25;
    float hum = 88;
    
    static char temperature_celsius[7];
    dtostrf(temp, 6, 2, temperature_celsius);
    dhtTemperatureCelsiusCharacteristics.setValue(temperature_celsius);
    dhtTemperatureCelsiusCharacteristics.notify();
    Serial.print("Temperatura: ");
    Serial.print(temp);
    Serial.print(" *C");

    static char humidity[7];
    dtostrf(hum, 6, 2, humidity);
    dhtHumidityCharacteristics.setValue(humidity);
    dhtHumidityCharacteristics.notify();
    Serial.print("  Humedad: ");
    Serial.print(hum);
    Serial.println(" %");
  }



    
  }

  

  //Parpadeo del LED
  static unsigned long parpadeo;
  if (millis() > parpadeo + 80) {
    digitalWrite(LED_BUILTIN, !digitalRead(LED_BUILTIN));
    parpadeo = millis();
  }

}

#include "BLEDevice.h"
#include "heltec.h"
#include "Arduino.h"


SSD1306Wire display(0x3c, SDA_OLED, SCL_OLED, RST_OLED); //128_64

#define SCREEN_WIDTH 128
#define SCREEN_HEIGHT 64

#define temperatureCelsius
#define BLE_server "ESP32_Server"


// Generador de UUIDs:
// https://www.uuidgenerator.net/

//***********************************
//BLE ID UNICO PARA SERVICIO
static BLEUUID                dhtServiceUUID("huecat23-6d3c-4a17-a71f-ece2e6075f9b");
//***********************************

//BLE ID UNICO PARA CARACTERÍSTICA (TEMPERATURA)
static BLEUUID temperatureCharacteristicUUID("huecat23-c85e-4596-9bd9-015e2eaa4888");

//BLE ID UNICO PARA CARACTERÍSTICA (HUMEDAD)
static BLEUUID    humidityCharacteristicUUID("huecat23-4a2f-4cf3-96e6-38b79be71a61");


/*

  //***********************************
  //BLE ID UNICO PARA SERVICIO
  static BLEUUID dhtServiceUUID("d29181ad-6d3c-4a17-a71f-ece2e6075f9b");
  //***********************************

  //BLE ID UNICO PARA CARACTERÍSTICA (TEMPERATURA)
  static BLEUUID temperatureCharacteristicUUID("ea4963df-c85e-4596-9bd9-015e2eaa4888");

  //BLE ID UNICO PARA CARACTERÍSTICA (HUMEDAD)
  static BLEUUID humidityCharacteristicUUID("b61decbb-4a2f-4cf3-96e6-38b79be71a61");


*/
static boolean bleConectado = false;
static boolean connected = false;

static BLEAddress *pServerAddress;
static BLERemoteCharacteristic* temperatureCharacteristic;
static BLERemoteCharacteristic* humidityCharacteristic;

const uint8_t notificationOn[] = {0x1, 0x0};
const uint8_t notificationOff[] = {0x0, 0x0};


bool conectarAServidor(BLEAddress pAddress) {
  BLEClient* pClient = BLEDevice::createClient();

  pClient->connect(pAddress);
  Serial.println("Conectado al Servidor");

  BLERemoteService* pRemoteService = pClient->getService(dhtServiceUUID);

  if (pRemoteService == nullptr) {
    Serial.print("Failed to find our service UUID: ");
    Serial.println(dhtServiceUUID.toString().c_str());
    return (false);
  }

  temperatureCharacteristic = pRemoteService->getCharacteristic(temperatureCharacteristicUUID);
  humidityCharacteristic = pRemoteService->getCharacteristic(humidityCharacteristicUUID);

  if (temperatureCharacteristic == nullptr || humidityCharacteristic == nullptr) {
    Serial.print("Failed to find our characteristic UUID");
    return false;
  }
  Serial.println(" Characteristics Found!");

  temperatureCharacteristic->registerForNotify(temperatureNotifyCallback);
  humidityCharacteristic->registerForNotify(humidityNotifyCallback);
}

class MyAdvertisedDeviceCallbacks: public BLEAdvertisedDeviceCallbacks {
    void onResult(BLEAdvertisedDevice advertisedDevice) {
      if (advertisedDevice.getName() == BLE_server) {
        advertisedDevice.getScan()->stop();
        pServerAddress = new BLEAddress(advertisedDevice.getAddress());
        bleConectado = true;
        Serial.println("Dispositivo encontrado. Conectando...");
      }
    }
};

static void temperatureNotifyCallback(BLERemoteCharacteristic*pBLERemoteCharacteristic, uint8_t* pData, size_t length, bool isNotify)
{

  String informarTemperatura = "";
  informarTemperatura = "Temperatura: ";
  informarTemperatura += (char*)pData;
  informarTemperatura += " *C";

  imprimirConAltura(informarTemperatura, 20); ////// IMPRIME OLED Y SERIAL //////

}

static void humidityNotifyCallback(BLERemoteCharacteristic* pBLERemoteCharacteristic, uint8_t* pData, size_t length, bool isNotify) {

  String informarHumedad = "Humedad: ";
  informarHumedad += (char*)pData;
  informarHumedad += " %";

  //imprimirConAltura(informarHumedad, 28); ////// IMPRIME OLED Y SERIAL //////

  Serial.println(informarHumedad);
}

void setup()
{
  Serial.begin(115200);
  Serial.println("\nESP-32--B-BLE-CLIENTE");

  ///////////////////////////////////////// PARA PANTALLA OLED
  initHeltecEsp32(); //Inicializaciones correspondientes a modelo Pantalla OLED elegido.

  imprimirConAltura("Comenzando conexión BLE ( Cliente)", 0); ////// IMPRIME OLED Y SERIAL //////

  BLEDevice::init("");

  BLEScan* pBLEScan = BLEDevice::getScan();
  pBLEScan->setAdvertisedDeviceCallbacks(new MyAdvertisedDeviceCallbacks());
  pBLEScan->setActiveScan(true);
  pBLEScan->start(30);


}
void loop() {

  if (bleConectado == true) {

    if (conectarAServidor(*pServerAddress)) {

      String conectando = "Conectado servidor BLE.";
      imprimirConAltura(conectando, 8); ////// IMPRIME OLED Y SERIAL //////

      temperatureCharacteristic->getDescriptor(BLEUUID((uint16_t)0x2902))->writeValue((uint8_t*)notificationOn, 2, true);
      humidityCharacteristic->getDescriptor(BLEUUID((uint16_t)0x2902))->writeValue((uint8_t*)notificationOn, 2, true);
      connected = true;
    } else {
      String conectando_error = "Falló conexión Servidor BLE";
      imprimirConAltura(conectando_error, 8); ////// IMPRIME OLED Y SERIAL //////
    }
    bleConectado = false;
  }
  delay(1000);
}



//Basado en ejemplo Heltec OLED_rotate.ino
void VextON(void)
{
  pinMode(Vext, OUTPUT);
  digitalWrite(Vext, LOW);
}

void VextOFF(void) //Vext default OFF
{
  pinMode(Vext, OUTPUT);
  digitalWrite(Vext, HIGH);
}

void initHeltecEsp32() {

  VextON();
  delay(100);

  display.init();
  display.clear();
  display.display();

  display.setContrast(1);

  display.setTextAlignment(TEXT_ALIGN_CENTER);
  display.clear();
  display.display();
  display.screenRotate(ANGLE_0_DEGREE);
  display.setFont(ArialMT_Plain_16);
  display.drawString(64, 32 - 16 / 2, "HUE CAT"); //ROTATE_0
  display.display();
  delay(400);

  display.clear();
  display.display();
  display.screenRotate(ANGLE_90_DEGREE);
  display.setFont(ArialMT_Plain_10);
  display.drawString(32, 64 - 10 / 2, "HUE CAT"); //ROTATE_90
  display.display();
  delay(400);

  display.clear();
  display.display();
  display.screenRotate(ANGLE_180_DEGREE);
  display.setFont(ArialMT_Plain_16);
  display.drawString(64, 32 - 16 / 2, "HUE CAT"); //ROTATE_180
  display.display();
  delay(400);

  display.clear();
  display.display();
  display.screenRotate(ANGLE_270_DEGREE);
  display.setFont(ArialMT_Plain_10);
  display.drawString(32, 64 - 10 / 2, "HUE CAT"); //ROTATE_270
  display.display();
  delay(400);

  display.clear();
  display.display();
  display.screenRotate(ANGLE_0_DEGREE);
  display.setFont(ArialMT_Plain_16);
  display.drawString(64, 32 - 16 / 2, "HUE CAT"); //ROTATE_0
  display.display();
  delay(500);

  display.clear();
  display.display();

  display.setTextAlignment(TEXT_ALIGN_LEFT);
  display.setFont(ArialMT_Plain_10);

}


void imprimirConAltura(String stringToPrint, int alturaAImprimir) {
  //Imprime en monitor serie y display
  Serial.print("OLED->" + stringToPrint);
  display.drawString(0, alturaAImprimir, stringToPrint);
  display.display();
}