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

const char ssid[] = "Wokwi-GUEST";
const char pass[] = " ";

 //Nomor pin GPIO
const int pinRead = 2;
const int pinGreen = 4;
const int pinBlue = 16;
const int pinLED = 13;
const int pinServo = 34;
const int pinPot = 33;
const int pinDHT = 25;

int pot, oldPot = 0;

void setup() {
  pinMode(pinRead, OUTPUT);
  pinMode(pinGreen, OUTPUT);
  pinMode(pinBlue, OUTPUT);
  pinMode(pinLED, OUTPUT);
  servo.attach(pinServo, 500, 2400);
  pinMode(pinPot, INPUT);
  dhtSensor.setup(pinDHT, DHTesp::DHT22);
  Serial.begin(9600);

WiFi.begin(ssid, pass);
client.begin("broker.emqx.io", net);

client.onMessage(subscribe);
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 == "ruanghinggap/led"){
    if(data == "nyala"){
      digitalWrite(pinLED, 1);
    }else if(data == "mati"){
      digitalWrite(pinLED, 0);
    }
  }
  if(topic == "ruanghinggap/servo"){
    int posServo = data.toInt();
    servo.write(posServo);
 }
}

void publishPot(){
  pot = analogRead(pinPot);

  if(pot != oldPot){
    client.publish("ruanghinggap/potentiometer", 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("---");
}

void rgb(bool red, bool green, bool blue){
  digitalWrite(pinRead, red);
  digitalWrite(pinGreen, green);
  digitalWrite(pinBlue, blue);
}

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

while(!client.connect("mqttx_b9f656ed")){
  delay(500);
}
rgb(0,0,1); // Biru 
client.subscribe("ruanghinggap/#, 1");
}