#include <WiFi.h>
#include <MQTT.h>
#include <ESP32Servo.h>
#include <NusabotSimpleTimer.h>
#include "DHTesp.h"

WiFiClient net;
MQTTClient client;
Servo servo;
NusabotSimpleTimer timer; 
DHTesp dhtSensor;
String serialNumber = "12345678";
const char ssid[] = "Wokwi-GUEST";
const char pass[] = "";

// Variable Pin GPIO
const int pinMerah = 2;
const int pinHijau = 4;
const int pinBiru = 16;
const int pinLED = 13;
const int pinServo = 18;
const int pinPot = 33;
const int pinDHT = 25;

int pot, oldPot = 0;

void setup() {
  pinMode(pinMerah, OUTPUT);
  pinMode(pinHijau, OUTPUT);
  pinMode(pinBiru, OUTPUT);
  pinMode(pinLED, OUTPUT);
  servo.attach(pinServo, 50, 2400);
  pinMode(pinPot, INPUT);
  dhtSensor.setup(pinDHT, DHTesp::DHT22);
  Serial.begin(115200);

  WiFi.begin(ssid, pass);
  client.begin("nusabot-jhon.cloud.shiftr.io", net);

  client.onMessage(subscribe);  //Mengeksekusi fungction "subscribe" Serial
  timer.setInterval(1000, publishPot);
  timer.setInterval(2000, publishDHT);

  connect();
}

void loop() {
  client.loop();
  timer.run();
  if(!client.connected());{
    connect();
  }

  delay(10);
}

void subscribe(String &topic, String &data){
  if(topic == "nusabot/"+ serialNumber +"/led"){
    if(data == "nyala"){
      digitalWrite(pinLED, 1);
    }else{
      digitalWrite(pinLED,0);
    }
  }

  if(topic == "nusabot/"+ serialNumber +"/servo"){
    int pos = data.toInt();
    servo.write(pos);
  }
}

void publishPot(){
  pot = analogRead(pinPot);  
  // Publish jika hanya terjadi perubahan nilai potensiometer
  if(pot != oldPot){
    client.publish("nusabot/"+ serialNumber +"/potensiometer", String(pot), false, 1);
    oldPot = pot;
  }
}

void publishDHT(){
  TempAndHumidity  data = dhtSensor.getTempAndHumidity();
  Serial.println("Temp: " + String(data.temperature, 2) + "°C");
  Serial.println("Humidity: " + String(data.humidity, 1) + "%");
  Serial.println("---");

  client.publish("kelasiot/suhu", String(data.temperature, 2), true, 1);
  client.publish("kelasiot/kelembaban", String(data.temperature, 2), true, 1);
}

void rgb(bool red, bool green, bool blue){
  digitalWrite(pinMerah, red);
  digitalWrite(pinHijau, green);
  digitalWrite(pinBiru, blue);
}

void connect(){
  rgb(1,0,0); //Merah
  while(WiFi.status() != WL_CONNECTED){
    delay(500);
  }
  rgb(0,1,0); //Hijau

  while(!client.connect("ESP32", "nusabot-jhon", "BMfadG8I2YUqM7p8")){
    delay(500);
  }
  rgb(0,0,1); //Biru

  client.subscribe("nusabot/#", 1);
}