#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[] = "";

const int pinRed = 2;
const int pinGreen = 4;
const int pinBlue = 16;
const int pinLED = 19;
const int pinServo = 18;
const int pinPot = 33;
const int pinDHT = 25;


int pot, oldPot = 0;

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


  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); // this speeds up the simulation

}

void subscribe(String &topic,String &data){
if(topic == "kelasiot/led"){
if(data == "nyala"){
digitalWrite(pinLED, 1);
}else if(data == "mati"){
digitalWrite(pinLED, 0);
}
}
if(topic == "kelasiot/servo"){
  int posServo = data.toInt();
  servo.write(posServo);
}
}

void publishPot(){
pot = analogRead(pinPot);
if(pot != oldPot){
client.publish("kelasiot/potentiometer", String(pot), false, 1);
oldPot = pot;
}
}

void publishDHT(){
TempAndHumidity data = dhtSensor.getTempAndHumidity();

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

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

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

  rgb(0,1,0);
  while (!client.connect("clientid-unik")){
    delay(500);
  }
   rgb(0,0,1);
   client.subscribe("kelasiot/#", 1);
}