#include <ESP32Servo.h>
#include <PubSubClient.h>
#include <DHT.h>
#include <WiFi.h>

const int DHTPIN = 5;
const int TRIG_PIN = 2;
const int ECHO_PIN = 4;
const int SERVO_PIN = 21;
const int THRESHOLD = 10;
#define DHTTYPE DHT22


DHT dht (DHTPIN, DHTTYPE); // inisiasi object kelas DHT dengan parameter pin, type) 
Servo servo; // inisiasi object kelas Servo

const char* ssid = "Wokwi-GUEST";
const char* password = "";
const char* mqtt_server = "test.mosquitto.org"; // merupakan server publik yang menyediakan layanan MQTT 

WiFiClient espClient; // membuat sebuah client dari kelas yang dapat terhubung ke alamat IP internet dan port tertentu seperti yang ditentukan di client.connect().
PubSubClient client(espClient); // sebuah lib untuk MQTT messaging
unsigned long lastMsg = 0;

float duration_us, distance_cm;

void func_setup_wifi() { //perintah koneksi wifi
  delay(5);
  // We start by connecting to a WiFi network
  Serial.println();
  Serial.print("Connecting to ");
  Serial.println(ssid);

  WiFi.mode(WIFI_STA); //setting wifi chip sebagai station/client
  WiFi.begin(ssid, password); //koneksi ke jaringan wifi

  while (WiFi.status() != WL_CONNECTED) { //perintah tunggu esp32 sampi terkoneksi ke wifi
    delay(500);
    Serial.print(".");
  }

  randomSeed(micros());

  Serial.println("");
  Serial.println("WiFi connected");
  Serial.println("IP address: ");
  Serial.println(WiFi.localIP());
}

void func_reconnect() { //perintah koneksi esp32 ke mqtt broker baik itu sebagai publusher atau subscriber
  // Loop until we're reconnected
  while (!client.connected()) {
    Serial.print("Attempting MQTT connection...");
    // perintah membuat client id agar mqtt broker mengenali board yang kita gunakan
    String clientId = "ESP32Client-";
    clientId += String(random(0xffff), HEX);
    // Attempt to connect
    if (client.connect(clientId.c_str())) {
      Serial.println("Connected");
      // Once connected, publish an announcement...
      client.publish("/goki/p/mqtt", "dts"); //perintah publish data ke alamat topik yang di setting
      // ... and resubscribe
      client.subscribe("/goki/p/mqtt"); //perintah subscribe data ke mqtt broker
    } else {
      Serial.print("failed, rc=");
      Serial.print(client.state());
      Serial.println(" try again in 5 seconds");
      // Wait 5 seconds before retrying
      delay(5000);
    }
  }
}

void func_callback(char* topic, byte* payload, unsigned int length) { //perintah untuk menampilkan data ketika esp32 di setting sebagai subscriber
  Serial.print("Message arrived [");
  Serial.print(topic);
  Serial.print("] ");
  for (int i = 0; i < length; i++) { //mengecek jumlah data yang ada di topik mqtt
    Serial.print((char)payload[i]);
  }
  Serial.println();

  // Switch on the LED if an 1 was received as first character
  if ((char)payload[0] == '1') {
    digitalWrite(2, LOW);   // Turn the LED on (Note that LOW is the voltage level
    // but actually the LED is on; this is because
    // it is active low on the ESP-01)
  } else {
    digitalWrite(2, HIGH);  // Turn the LED off by making the voltage HIGH
  }
}

void setup() {
  Serial.begin (9600); 
  func_setup_wifi(); 
  client.setServer(mqtt_server, 1883); //perintah connecting / koneksi awal ke broker
  client.setCallback(func_callback); //perintah menghubungkan ke mqtt broker untuk subscribe data
  pinMode(TRIG_PIN, OUTPUT); // mengatur pin TRIG_PIN sebagai output
  pinMode(ECHO_PIN, INPUT); // mengatur pin ECHO_PIN sebagai input
  servo.attach(SERVO_PIN); // menghubungkan/mengait servo ke pin
  servo.write(0); // normalisasi servo
  dht.begin(); // memulai sensor DHT
}

void loop() {
  if (!client.connected()) {
    func_reconnect();
  }
  client.loop();
  unsigned long now = millis();
  if (now - lastMsg > 2000) { //perintah publish data
    lastMsg = now;
    float t = dht.readTemperature();
    float h = dht.readHumidity();
    String s = " ";

    digitalWrite(TRIG_PIN, HIGH);
    delayMicroseconds(10);
    digitalWrite(TRIG_PIN, LOW);
    duration_us = pulseIn(ECHO_PIN, HIGH);
    distance_cm = 0.017 * duration_us;

    if (distance_cm < THRESHOLD) {
      servo.write(0); 
      s = "tutup";
    }
    else {
      servo.write(90);
      s = "buka";
    }
    String temp; //membuat variabel temp untuk di publish ke broker mqtt
    temp = String(t);
    client.publish("/goki/p/temp", temp.c_str()); //publish data dari varibel temp ke broker mqtt
    
    String hum; //membuat variabel hum untuk di publish ke broker mqtt
    hum = String(h);
    client.publish("/goki/p/hum", hum.c_str()); //publish data dari varibel hum ke broker mqtt
    client.publish("/goki/p/serv", s.c_str());
    client.publish("/goki/p/dstc", String(distance_cm).c_str());
    

    Serial.print("Suhu = ");
    Serial.print(t);
    Serial.println(" C");
    Serial.print("Kelembaban = ");
    Serial.print(h);
    Serial.println(" %");
    Serial.print("Pintu: ");
    Serial.println(s);
    Serial.print("distance: ");
    Serial.print(distance_cm);
    Serial.println(" cm");
    delay(1000);
  }
}