// #include <ESP8266WiFi.h> // Untuk ESP8266
#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[] = "";

// Variabel Pin GPIO
const int pinMerah = 27;
const int pinHijau = 26;
const int pinBiru = 25;
const int pinLED = 33;
const int servoPin = 18;
const int pinPot = 35;

void setup() {
  pinMode(pinMerah, OUTPUT);
  pinMode(pinHijau, OUTPUT);
  pinMode(pinBiru, OUTPUT);
  pinMode(pinLED, OUTPUT);
  pinMode(pinPot, INPUT);

  servo.attach(servoPin, 500, 2400);

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

  client.onMessage(subscribe);

  timer.setInterval(1000, publish);
  connect();
}

void connect(){
  Serial.print("Menghubungkan ke WiFi");
  rgb(1,0,0);
  while(WiFi.status() != WL_CONNECTED){
    Serial.print(".");
    delay(500);
  }
  Serial.println("Berhasil Terhubung ke WiFi");
    rgb(0,1,0);
  
  while(!client.connect("wokwi-device")){
    delay(500);
  }
  rgb(0,0,1);

  client.subscribe("nusabot/#", 1);
}

void loop() {
  client.loop();
  timer.run();

  //Fitur Reconnect
  if(!client.connected()) {
    connect();
  }

  delay(10); // this speeds up the simulation
}

void publish() {
  int pot = analogRead(pinPot);
  client.publish("nusabot/potensiometer", String(pot), false, 1);
  //client.publish("nusabot/coba", "mantap", false, 1); // <------
}

void subscribe(String &topic, String &data) {
  // Serial.print("Topik: ");
  // Serial.print(topic);
  // Serial.print("Data: ");
  // Serial.print(data);
  if(topic == "nusabot/led"){
    if(data == "nyala"){
      digitalWrite(pinLED, 1);
    } else {
      digitalWrite(pinLED, 0);
    }
  } 

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

void rgb(bool red, bool green, bool blue){
  digitalWrite(pinMerah, red);
  digitalWrite(pinHijau, green);
  digitalWrite(pinBiru, blue);
}