#include <WiFi.h>           // WiFi control for ESP32
//#include <ThingsBoard.h>    // ThingsBoard SDK
#include "ThingsBoard.h"
#include <ESP32Servo.h>

#define COUNT_OF(x) ((sizeof(x)/sizeof(0[x])) / ((size_t)(!(sizeof(x) % sizeof(0[x])))))

#define WIFI_AP_NAME              "Wokwi-GUEST"
#define WIFI_PASSWORD             ""
#define THINGSBOARD_SERVER        "36.94.212.65"
#define THINGSBOARD_ACCESSTOKEN   "SERVO_TEST" // access token dari device thingsboard yang digunakan
#define SERIAL_DEBUG_BAUD    115200

const int hujanPin = 35;
const int cahayaPin = 34;
const int servoPin = 2;
const int merah = 4;
const int hijau = 22;

Servo servo;

WiFiClient espClient;
ThingsBoard tb(espClient);
int status = WL_IDLE_STATUS;

// Array with LEDs that should be lit up one by one
uint8_t leds_cycling[] = { 21, 19, 18 };
// Array with LEDs that should be controlled from ThingsBoard, one by one
uint8_t leds_control[] = { 26, 33, 25 };
uint8_t pin = 15;


// Main application loop delay
int quant = 20;
// Initial period of LED cycling.
int led_delay = 1000;
// Period of sending a temperature/humidity data.
int send_delay = 5000;

// Time passed after LED was turned ON, milliseconds.
int led_passed = 0;
// Time passed after temperature/humidity data was sent, milliseconds.
int send_passed = 0;

// Set to true if application is subscribed for the RPC messages.
bool subscribed = false;
// LED number that is currenlty ON.
int current_led = 0;


RPC_Response processDelayChange(const RPC_Data &data)
{
  // Serial.println("Received the set delay RPC method");
  Serial.println("Received from control widget");

  // Process data

  led_delay = data;

  // Serial.print("Set new delay: ");
  Serial.print("Set ATAP : ");
  // Serial.println(led_delay);
  if (led_delay == 1) {
    Serial.println("Kontrol Manual Aktif");
    digitalWrite(merah, HIGH);
    digitalWrite(hijau, LOW);
  } else if (led_delay == 0) {
    Serial.println("Kontrol Otomatis Aktif");
    digitalWrite(merah, LOW);
    digitalWrite(hijau, HIGH);
  }

  return String(led_delay);
}

RPC_Response processGetDelay(const RPC_Data &data)
{
  Serial.println("Received the get value method");
  return String(led_delay);
}

RPC_Response processSetGpioState(const RPC_Data &data)
{
  Serial.println("Received the set GPIO RPC method");

  int pin = data["pin"];
  bool enabled = data["enabled"];

    Serial.print("Setting LED ");
    Serial.print(pin);
    Serial.print(" to state ");
    Serial.println(enabled);

    digitalWrite(pin, enabled);
    if (enabled == 1) {
      servo.write(90);
    } else if (enabled == 0){
      servo.write(180);
    }

  return String("{\"" + String(pin) + "\": " + String(enabled?"true":"false") + "}");
}

RPC_Response processGetGpioState(const RPC_Data &data)
{
  Serial.println("Received the get GPIO RPC method");
  String respStr = "{";
  
    int pin = 15;
    Serial.print("Getting LED ");
    Serial.print(pin);
    Serial.print(" state ");
    bool ledState = digitalRead(pin);
    Serial.println(ledState);

    respStr += String("\"" + String(pin) + "\": " + String(ledState?"true":"false") + ", ");
  
  respStr = respStr.substring(0, respStr.length() - 2);
  respStr += "}";
  return respStr;
}


// RPC handlers
RPC_Callback callbacks[] = {
  { "setValue",         processDelayChange },
  { "getValue",         processGetDelay },  
  { "setGpioStatus",    processSetGpioState },
  { "getGpioStatus",    processGetGpioState },
};

void setup() {
  Serial.begin(SERIAL_DEBUG_BAUD);
  WiFi.begin(WIFI_AP_NAME, WIFI_PASSWORD);
  InitWiFi();
  pinMode(15, OUTPUT);
  pinMode(4, OUTPUT);
  pinMode(22, OUTPUT);
  servo.attach(servoPin, 500, 2400);
  // Pinconfig
  for (size_t i = 0; i < COUNT_OF(leds_cycling); ++i) {
    pinMode(leds_cycling[i], OUTPUT);
  }

  for (size_t i = 0; i < COUNT_OF(leds_control); ++i) {
    pinMode(leds_control[i], OUTPUT);
  }


}

void loop() 
{
  delay(quant);

  led_passed += quant;
  send_passed += quant;

  // Check if next LED should be lit up
  if (led_passed > led_delay) {
    // Turn off current LED
    digitalWrite(leds_cycling[current_led], LOW);
    led_passed = 0;
    current_led = current_led >= 2 ? 0 : (current_led + 1);
    // Turn on next LED in a row
    digitalWrite(leds_cycling[current_led], HIGH);
  }

  // Reconnect to WiFi, if needed
  if (WiFi.status() != WL_CONNECTED) {
    reconnect();
    return;
  }

  // Reconnect to ThingsBoard, if needed
  if (!tb.connected()) {
    subscribed = false;

    // Connect to the ThingsBoard
    Serial.print("Connecting to: ");
    Serial.print(THINGSBOARD_SERVER);
    Serial.print(" with token ");
    Serial.println(THINGSBOARD_ACCESSTOKEN);
    if (!tb.connect(THINGSBOARD_SERVER, THINGSBOARD_ACCESSTOKEN)) {
      Serial.println("Failed to connect");
      return;
    }
  }

  // Subscribe for RPC, if needed
  if (!subscribed) {
    Serial.println("Subscribing for RPC... ");

    // Perform a subscription. All consequent data processing will happen in
    // callbacks as denoted by callbacks[] array.
    if (!tb.RPC_Subscribe(callbacks, COUNT_OF(callbacks))) {
      Serial.println("Failed to subscribe for RPC");
      return;
    }

    Serial.println("Subscribe done");
    subscribed = true;
  }  

  // Check if it is a time to send DHT22 temperature and humidity
  if (send_passed > send_delay) {
      const float GAMMA = 0.7;
      const float RL10 = 50;
      
      int sensorCahaya = analogRead(cahayaPin);   // Baca nilai sensor
      int sensorHujan = analogRead(hujanPin);
      
      float voltage = sensorCahaya / 4096. * 5;
      float resistance = 2000 * voltage / (1 - voltage / 5);
      float lux = pow(RL10 * 1e3 * pow(10, GAMMA) / resistance, (1 / GAMMA));

      
      tb.sendTelemetryInt("Cahaya", lux);
      tb.sendTelemetryInt("Hujan", sensorHujan);


      if (digitalRead(hijau) == 1) {
        if(lux > 30000 || sensorHujan > 900){
          digitalWrite(15, HIGH);
          servo.write(90);
        }
        else if (lux < 30000 || sensorHujan < 900){
          digitalWrite(15, LOW);
          servo.write(180);
        }
      }
      Serial.println();
      Serial.print("Sending Data ... ");
      Serial.print("Cahaya: ");
      Serial.print(lux);
      Serial.print(" Hujan: ");
      Serial.print(sensorHujan);

      send_passed = 0;
  }
  tb.loop();
}

void InitWiFi()
{
  Serial.println("Connecting to AP ...");
  // attempt to connect to WiFi network

  WiFi.begin(WIFI_AP_NAME, WIFI_PASSWORD);
  while (WiFi.status() != WL_CONNECTED) {
    delay(500);
    Serial.print(".");
  }
  Serial.println("Connected to AP");
}

void reconnect() {
  // Loop until we're reconnected
  status = WiFi.status();
  if ( status != WL_CONNECTED) {
    WiFi.begin(WIFI_AP_NAME, WIFI_PASSWORD);
    while (WiFi.status() != WL_CONNECTED) {
      delay(500);
      Serial.print(".");
    }
    Serial.println("Connected to AP");
  }
}