//This example code is in the Public Domain (or CC0 licensed, at your option.)
//By Richard Li - 2020
//
//This example creates a bridge between Serial and Classical Bluetooth (SPP with authentication)
//and also demonstrate that SerialBT have the same functionalities of a normal Serial

#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

#if !defined(CONFIG_BT_SPP_ENABLED)
#error Serial Bluetooth not available or not enabled. It is only available for the ESP32 chip.
#endif

#define LED_CONNECT 2
#define LED_POWER 15

#define PIN_POWER 13
#define PIN_LOCK 12
#define PIN_LOOP 14

boolean isConnectDevice = false;

BluetoothSerial SerialBT;
boolean confirmRequestPending = true;

void BTConfirmRequestCallback(uint32_t numVal)
{
  confirmRequestPending = true;
  Serial.println(numVal);
}

void BTAuthCompleteCallback(boolean success)
{
  confirmRequestPending = false;
  if (success)
  {
    Serial.println("Pairing success!!");
  }
  else
  {
    Serial.println("Pairing failed, rejected by user!!");
  }
}

// Bt_Status callback function
void Bt_Status (esp_spp_cb_event_t event, esp_spp_cb_param_t *param) {

  if (event == ESP_SPP_SRV_OPEN_EVT) {
    Serial.println ("Client Connected");
    digitalWrite(LED_CONNECT, HIGH);
    isConnectDevice = true;
    confirmRequestPending = false;
    // Do stuff if connected
  }

  else if (event == ESP_SPP_CLOSE_EVT ) {
    Serial.println ("Client Disconnected");
    digitalWrite(LED_CONNECT, LOW);
    isConnectDevice = false;
    // Do stuff if not connected
  }
}

void get_start() {
    digitalWrite(LED_POWER, HIGH);
    digitalWrite(PIN_POWER, HIGH);
}

void cut_power() {
    digitalWrite(LED_POWER, LOW);
    digitalWrite(PIN_POWER, LOW);
}

void lock_car() {
    digitalWrite(PIN_LOCK, LOW);
    delay(500);
    digitalWrite(PIN_LOCK, HIGH);
    delay(10000);
    digitalWrite(LED_POWER, LOW);
    digitalWrite(PIN_POWER, LOW);
}

void luncher_car() {
    digitalWrite(PIN_LOCK, LOW);
    delay(300);
    digitalWrite(PIN_LOCK, HIGH);
    delay(1000);
    digitalWrite(PIN_LOOP, LOW);
    delay(8000);
    digitalWrite(PIN_LOOP, HIGH);
}

void shut_down_car() {
    digitalWrite(PIN_LOOP, LOW);
    delay(8000);
    digitalWrite(PIN_LOOP, HIGH);
}

void find_my_car() {
    digitalWrite(PIN_LOOP, LOW);
    delay(200);
    digitalWrite(PIN_LOOP, HIGH);
    delay(300);
    digitalWrite(PIN_LOOP, LOW);
    delay(200);
    digitalWrite(PIN_LOOP, HIGH);
}

void click_loop() {
    digitalWrite(PIN_LOOP, LOW);
    delay(200);
    digitalWrite(PIN_LOOP, HIGH);
}

void click_lock() {
    digitalWrite(PIN_LOCK, LOW);
    delay(200);
    digitalWrite(PIN_LOCK, HIGH);
}

void read_status() {
  int power_value = digitalRead(PIN_POWER);
  int loop_value = digitalRead(PIN_LOOP);
  int lock_value = digitalRead(PIN_LOCK);

  char s[200];
  sprintf(s, "power %d, loop %d, lock %da\n", power_value, loop_value, lock_value);
  SerialBT.print(s);
}

void setup()
{
  Serial.begin(115200);

  pinMode(LED_CONNECT, OUTPUT);
  pinMode(LED_POWER, OUTPUT);
  
  pinMode(PIN_POWER, OUTPUT);
  pinMode(PIN_LOCK, OUTPUT);
  pinMode(PIN_LOOP, OUTPUT);

  digitalWrite(PIN_LOCK, HIGH);
  digitalWrite(PIN_LOOP, HIGH);
  
  SerialBT.enableSSP();
  SerialBT.onConfirmRequest(BTConfirmRequestCallback);
  SerialBT.onAuthComplete(BTAuthCompleteCallback);
    // Define the Bt_Status callback
  SerialBT.register_callback (Bt_Status);
  SerialBT.begin("equationl's Auto"); //Bluetooth device name
  Serial.println("The device started, now you can pair it with bluetooth!");
}

void loop()
{
  if (confirmRequestPending)
  {
    if (Serial.available())
    {
      int dat = Serial.read();
      if (dat == '1')
      {
        SerialBT.confirmReply(true);
      }
      else
      {
        SerialBT.confirmReply(false);
      }
    }
  }
  else
  {
    if (Serial.available())
    {
      SerialBT.write(Serial.read());
    }
    if (SerialBT.available())
    {
      int msg = SerialBT.read();
      Serial.write(msg);
      if (msg == '1') {
        get_start();
      }
      if (msg == '2') {
        cut_power();
      }
      if (msg == '3') {
        lock_car();
      }
      if (msg == '4') {
        luncher_car();
      }
      if (msg == '5') {
        shut_down_car();
      }
      if (msg == '6') {
        find_my_car();
      }
      if (msg == '7') {
        click_loop();
      }
      if (msg == '8') {
        click_lock();
      }
      if (msg == 'r') {
        read_status();
      }
    }
    delay(5);
  }
}