#include <DHTesp.h>         // DHT for ESP32 library
#include <WiFi.h>           // WiFi control for ESP32
#include "ThingsBoard.h"
#include <ESP32Servo.h>

//Count_OFF(x) untuk menghitung jumlah array
#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        "thingsboard.cloud"
#define THINGSBOARD_ACCESSTOKEN   "0NubpLZ05ZkQeuYQe73Y" 
//#define THINGSBOARD_ACCESSTOKEN   "gaYk8QTeFiTUD5HUcuTv"

#define pinRelayMotor 18          //Relay 1 - Untuk Pompa Air
#define pinRelayAtap 19     //Relay 2 - Untuk mekanisme atap (perlu tambahan sensor stopper)

const float GAMMA = 0.7;
const float RL10 = 50;
WiFiClient espClient;
ThingsBoard tb(espClient);
int status = WL_IDLE_STATUS;
int lampAtap = 0;       //indikator atap buka/tutup

// deklarasi array untuk pin pendingin yang dikontrol melalui thingsboard
//uint8_t aircond_control[] = { 13, 12 };

// deklarasi array untuk pin led yang dikontrol melalui thingsboard
uint8_t leds_control[] = { 2, 4 };

DHTesp dht;
#define DHT_PIN 15
#define LDR 35
int i;
// Main application loop delay
int quant = 2000;
float control_tem = 0;
int control_lamp1 = 0;
int control_lamp2 = 0;

// Period of sending a temperature/humidity data.
int send_delay = 2000;

// 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;

float temperature = 0;
float humidity = 0;

//Untuk proses mengubah temperature kontrol dari thingsboard :
//Opsional saja
RPC_Response processTempChange(const RPC_Data &data)
{
  Serial.println("Received the set delay RPC method");

  // Process data

  control_tem = data;

  Serial.print("Atur suhu ke: ");
  Serial.println(control_tem);

  return String(control_tem);
}

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

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

  // Process data

  control_lamp1 = data;

  Serial.println(control_lamp1);

  return String(control_lamp1);
}

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

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

  // Process data

  control_lamp2 = data;

  Serial.println(control_lamp2);

  return String(control_lamp2);
}

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

RPC_Response processCheckAtap(const RPC_Data &data)
{
  return String(lampAtap);
}

// RPC handlers
RPC_Callback callbacks[] = {
  { "setValue",         processTempChange },
  { "getValue",         processGetTemp },
  { "setSwitch1",       processSwitch1Change },
  { "getSwitch1",       processGetSwitch1 },  
  { "setSwitch2",       processSwitch2Change },
  { "getSwitch2",       processGetSwitch2 },
  { "checkAtap",        processCheckAtap }
};

void setup() {
  Serial.begin(115200);
  pinMode(LDR, INPUT);
  pinMode(5, OUTPUT);
  pinMode(pinRelayMotor, OUTPUT);
  pinMode(pinRelayAtap, OUTPUT);
  connect();

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

  // Initialize temperature sensor
  dht.setup(DHT_PIN, DHTesp::DHT22);
}


void loop() 
{
  delay(quant);
  int analogValue = analogRead(LDR);
  float voltage = analogValue * 5 / 4095.0 ;
  float resistance = 2000 * voltage / (1 - voltage / 5);
  float lux = pow(RL10 * 1e3 * pow(10, GAMMA) / resistance, (1 / GAMMA));
  
  //Logic kondisi buka tutup atap di sini, bang :
  //Untuk standar nilai Lux berapa, saat atap harus ditutup ?
  if(lux <= 500){
    digitalWrite(pinRelayAtap, LOW);
    Serial.print("Atap Terbuka ");
    digitalWrite(lampAtap, true);
  } else {
    digitalWrite(pinRelayAtap, HIGH);
    Serial.print("Atap Tertutup ");
    digitalWrite(lampAtap, false);
  }
  send_passed += quant;

  // Reconnect to WiFi, if needed
  if (WiFi.status() != WL_CONNECTED) {
    connect();
    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;
  } 

  digitalWrite(leds_control[0], control_lamp1);
  digitalWrite(leds_control[1], control_lamp2);
 
  
  // Check if it is a time to send DHT22 temperature, humidity and Intensity
  if (send_passed > send_delay) {
    Serial.println();
    Serial.print("Sending data... ");

    TempAndHumidity lastValues = dht.getTempAndHumidity();    

    if (isnan(lastValues.humidity) || isnan(lastValues.temperature)) {
      Serial.println("Failed to read from DHT sensor!");
    } else {
      temperature = lastValues.temperature;
      Serial.print("Suhu: ");
      Serial.print(temperature);

      humidity = lastValues.humidity;
      Serial.print(", Kelembaban: ");
      Serial.println(humidity);

      Serial.print("Intensitas Cahaya: ");
      Serial.println(lux);
      
      //Send data telemetry to thingsboard here :
      tb.sendTelemetryFloat("suhu-proj", temperature);
      tb.sendTelemetryFloat("Kelembapan-proj", humidity);
      tb.sendTelemetryFloat("Intensitas-proj", lux);
      
    }

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

void connect()
{
  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");
}