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

WiFiClient net;
MQTTClient client;
Servo servo; //objek dari servo

const char ssid[] = "Wokwi-GUEST"; //nama WiFi
const char pass[] = ""; //password WiFi


//Nomor Pin
const int pinRed = 2;
const int pinGreen = 4;
const int pinBlue = 16;
const int pinLED = 13;
const int pinServo = 34;


void setup() {
  pinMode(pinRed, OUTPUT);
  pinMode(pinGreen, OUTPUT);
  pinMode(pinBlue, OUTPUT);
  pinMode(pinLED, OUTPUT);
  servo.attach(pinServo, 500, 2400);//untuk servo
  
  WiFi.begin(ssid, pass);
  client.begin("broker.emqx.io", net);

  client.onMessage(subscribe);

  connect();
}

void loop() {
  client.loop();
  if(!client.connected()){ //fungsi reconnect
    connect();
  }

  delay(10);
}

void subscribe(String &topic, String &data){//yg Data adalah nama variabel
  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();//data yg di konfersi ke tipe data interger
    servo.write(posServo);
  }
}


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

void connect(){ //funtion ini berfungsi untuk menghububgkan perangkat esp32 ke WiFi dan broker
  rgb(1,0,0);//jika sedang proses connect ke WiFi maka led RED menyala
  while(WiFi.status() != WL_CONNECTED){
  delay(500);

  }
  rgb(0,1,0); //jika terhubung ke WiFi led GREEN menyala

  while(!client.connect("code_unik")){ //code_unik
  delay(500);
  }
  rgb(0,0,1);//jika terhubung ke broker led BLUE mw=enyala
  client.subscribe("kelasiot/#", 1);//subscribe ke QoS 1
}