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

WiFiClient net;
MQTTClient client;
Servo servo;
NusabotSimpleTimer timer;

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

//Nomor pin GPIO RGB
const int pinRed = 2;
const int pinGreen = 4;
const int pinBlue = 16;

//Nomor pin GPIO LED
const int pinYellow = 12;
const int pinCyan = 13;

//Servo
const int pinServo = 18;

void setup(){
  pinMode(pinRed, OUTPUT);
  pinMode(pinGreen, OUTPUT);
  pinMode(pinBlue, OUTPUT);
  pinMode(pinYellow, OUTPUT);
  pinMode(pinCyan, OUTPUT);
  servo.attach(pinServo, 500, 2400);
  Serial.begin(9600);

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

  client.onMessage(subscribe);
  timer.setInterval(500, publish);

  connect();
}

void loop(){
  client.loop();
  timer.run();
  if(!client.connected()){
    connect();
  }
  delay(10);        //jangan digunakan di real project
}

void subscribe(String &topic, String &data){
  if(topic == "kelasiot/ledY"){
    if(data == "nyala"){
      digitalWrite(pinYellow, 1);
    } else if(data == "mati"){
      digitalWrite(pinYellow, 0);
    }
  }

  if(topic == "kelasiot/ledC"){
    if(data == "nyala"){
      digitalWrite(pinCyan, 1);
    } else if(data == "mati"){
      digitalWrite(pinCyan, 0);
    }
  }

  if(topic == "kelasiot/servo"){
    int posServo = data.toInt();
    servo.write(posServo);
  }
}

void publish(){
  Serial.println("Halo");
}

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

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

  while(!client.connect("clientid-ws")){
    delay(500);
  }
  rgb(0, 0, 1);

  client.subscribe("kelasiot/#", 1); //Subscribe menggunakan QoS 1
}