#if defined(ESP8266)
#include <ESP8266WiFi.h>
#elif defined(ESP32)
#include <WiFi.h>
#endif

#include "ThingsBoard.h"
#include "DHTesp.h"

#define WIFI_SSID           "Wokwi-GUEST"
#define WIFI_PASSWORD       ""

#define TOKEN               "ilJ6fmlQrXvUjcttQ98X"
#define THINGSBOARD_SERVER  "thingsboard.cloud"


// Baud rate for debug serial
#define SERIAL_DEBUG_BAUD   115200

#define DHT_PIN 15
#define pinTrig 12
#define pinEcho 14
#define pinLDR  34

const float GAMMA = 0.7;
const float RL10 = 50;

DHTesp dhtSensor;

// Initialize ThingsBoard client
WiFiClient espClient;
// Initialize ThingsBoard instance
ThingsBoard tb(espClient);
// the Wifi radio's status
int status = WL_IDLE_STATUS;

float readLDR() {
  int analogValue = analogRead(pinLDR);
  float voltage = analogValue / 1024. * 5;
  float resistance = 2000 * voltage / (1 - voltage / 5);
  float lux = pow(RL10 * 1e3 * pow(10, GAMMA) / resistance, (1 / GAMMA));

  return lux;
}

float readDistanceCM(){
  // Clears the trigPin
  digitalWrite(pinTrig, LOW);
  delayMicroseconds(2);

  // Sets the trigPin on HIGH state for 10 micro seconds
  digitalWrite(pinTrig, HIGH);
  delayMicroseconds(10);
  digitalWrite(pinTrig, LOW);

  // Reads the echoPin, returns the sound wave travel time in microseconds
  int duration = pulseIn(pinEcho, HIGH);

  // Calculating the distance
  return duration * 0.0344 / 2;
}

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

  WiFi.begin(WIFI_SSID, 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_SSID, WIFI_PASSWORD);
    while (WiFi.status() != WL_CONNECTED) {
      delay(500);
      Serial.print(".");
    }
    Serial.println("Connected to AP");
  }
}

void setup() {
  // initialize serial for debugging
  Serial.begin(SERIAL_DEBUG_BAUD);
  Serial.println();

  pinMode(pinTrig, OUTPUT);
  pinMode(pinEcho, INPUT);  

  InitWiFi();
  dhtSensor.setup(DHT_PIN, DHTesp::DHT22);
}

void loop() {
  delay(1500);

  if (WiFi.status() != WL_CONNECTED) {
    reconnect();
  }

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

  Serial.println("Sending data...");

  TempAndHumidity  data = dhtSensor.getTempAndHumidity();
  tb.sendTelemetryInt("Suhu", data.temperature);
  tb.sendTelemetryFloat("Kelembaban", data.humidity);

  tb.sendTelemetryFloat("Intensitas", readLDR());

  tb.sendTelemetryFloat("Jarak", readDistanceCM());

  Serial.println("Suhu : " + String(data.temperature));  
  Serial.println("Kelembaban : " + String(data.humidity));
  Serial.println("Intensitas : " + String(readLDR()));
  Serial.println("Jarak : " + String(readDistanceCM()));

  tb.loop();
}