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

const int pinRed   = 2;
const int pinGreen = 4;
const int pinBlue  = 17;
const int ledMerah = 14; 
const int pinServo =18;
const int pinPot  =35;

int pot;

void setup() {
  pinMode(pinRed, OUTPUT);
  pinMode(pinGreen, OUTPUT);
  pinMode(pinBlue, OUTPUT);
  pinMode(ledMerah, OUTPUT);
  pinMode(pinPot, INPUT);

  servo.attach(pinServo, 500, 2400);
  Serial.begin(9600);
  WiFi.begin(ssid,pass);
  Client.begin("broker.emqx.io", net);
  Client.onMessage(subscribe);

  timer.setInterval(2000, publishPot);
  reconnect();
}

void loop() {
  Client.loop();
  timer.run();
  if(!Client.connected()){
    reconnect();
  }
  // put your main code here, to run repeatedly:
  delay(10); // this speeds up the simulation
}

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

void reconnect(){
  rgb(1,0,0); //merah
  while (WiFi.status() != WL_CONNECTED){
    delay(500);
  }
 rgb(0,1,0);
 while (!Client.connect("Client-connnect-01")){
  delay(500);
 }
 rgb(0,0,1); //biru
 Client.subscribe("belajar/#", 1);
}

void publishPot(){
  pot=analogRead(pinPot);
  Serial.println(pot);
  Client.publish("belajar/potensio", String(pot), false, 1);

}

void subscribe(String &topic, String &data){

  if(topic == "belajar/led"){
    data.trim();
    if(data=="ON"){
      digitalWrite(ledMerah,1);
    } 
    else if(data=="OFF"){
      digitalWrite(ledMerah,0);
    }
  }
  if (topic == "belajar/servo"){
    data.trim();
    int posServo = data.toInt();
    servo.write(posServo);
    Serial.println(posServo);
  }
}