#include <WiFi.h>
#include <Servo.h>
#include <Adafruit_SSD1306.h>
#include <Adafruit_GFX.h>
#include <Adafruit_NeoPixel.h>

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

#define CURRENT_FIRMWARE_TITLE    "Case 2"
#define CURRENT_FIRMWARE_VERSION  "1.0.0"

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

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

#define SERIAL_DEBUG_BAUD   115200

const int DHT_PIN = 15;

Adafruit_SSD1306 display( 128, 64);

DHTesp dhtSensor;

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

#define relay1 32
#define relay2 33
#define relay3 25

Servo myServo;
Servo myServo2;

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() {
  // put your setup code here, to run once:
  pinMode(relay1, OUTPUT);
  pinMode(relay2, OUTPUT);
  pinMode(relay3, OUTPUT);

  Serial.begin(SERIAL_DEBUG_BAUD);
  Serial.println("Hello, ESP32!");
  Serial.println();

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

  myServo.attach(18);
  myServo2.attach(5);

  myServo.write(0);
  myServo2.write(0);

  display.begin(SSD1306_SWITCHCAPVCC, 0x3C);
  display.clearDisplay();
  display.setTextColor(1);
  display.setTextSize(1);
  display.display();

}

void loop() {
  // put your main code here, to run repeatedly:
  delay(1000);

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

  TempAndHumidity  data = dhtSensor.getTempAndHumidity();
  String temp = String(data.temperature,2);

  display.clearDisplay();
  display.setCursor(20, 0);
  display.print("Suhu: ");
  display.print(temp);
  display.print(" °C");

  if(data.temperature < 26){
    digitalWrite(relay1, LOW);
    digitalWrite(relay2, LOW);
    digitalWrite(relay3, HIGH);
    myServo2.write(90);
    myServo.write(0);
    display.setCursor(0, 20);
    display.print("SUHU RENDAH");
    Serial.print(F("Suhu Temperature: "));
    Serial.print(temp);
    Serial.print(F(" °C"));
    Serial.println(F(" SUHU RENDAH"));
    Serial.println("Sending data...");
    tb.sendTelemetryFloat("Temperature", data.temperature);
  }else if(data.temperature = 26 && data.temperature <= 34){
    digitalWrite(relay1, LOW);
    digitalWrite(relay2, HIGH);
    digitalWrite(relay3, LOW);
    myServo2.write(0);
    myServo.write(0);
    display.setCursor(0, 20);
    display.print("SUHU NORMAL");
    Serial.print(F("Suhu Temperature: "));
    Serial.print(temp);
    Serial.print(F(" °C"));
    Serial.println(F(" SUHU NORMAL"));
    Serial.println("Sending data...");
    tb.sendTelemetryFloat("Temperature", data.temperature);
  }else{
    digitalWrite(relay1, HIGH);
    digitalWrite(relay2, LOW);
    digitalWrite(relay3, LOW);
    myServo2.write(0);
    myServo.write(90);
    display.setCursor(0, 20);
    display.print("SUHU TINGGI");
    Serial.print(F("Suhu Temperature: "));
    Serial.print(temp);
    Serial.print(F(" °C"));
    Serial.println(F(" SUHU TINGGI"));
    Serial.println("Sending data...");
    tb.sendTelemetryFloat("Temperature", data.temperature);
  }

  display.display();

  tb.loop();
  tb.loop();
}