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

WiFiClient net;
MQTTClient client;
Servo servo;


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

const int pinRed = 2;
const int pinGreen = 4;
const int pinBlue = 16;
const int pinLED = 13;
const int pinServo = 18;

void setup() {
  pinMode(pinRed, OUTPUT);
  pinMode(pinGreen, OUTPUT);
  pinMode(pinBlue, OUTPUT);
  pinMode(pinLED, OUTPUT);
  servo.attach(pinServo, 500, 2400);


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

  client.onMessage(subscribe);
  
  connect();
}

void loop() {
  client.loop();
  if(!client.connected()){
    connect();
  }
  delay(10);
}

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 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("mqttx_a859e652")){
    delay(500); 
  }
  rgb(0,0,1); // biru
  client.subscribe("kelasiot/#", 1); //subscribe menggunakan Qos 1
}