#include <WiFi.h>
#include "PubSubClient.h"

const char* ssid = "Wokwi-GUEST";
const char* password = "";
const char* mqttServer = "broker.emqx.io";
int port = 1883;
String stMac;
char mac[50];
char clientId[50];

WiFiClient espClient;
PubSubClient client (espClient);

unsigned long pesanTerakhir = 0;
#define MSG_BUFFER_SIZE (50)
char pesan [MSG_BUFFER_SIZE];
int nilaivalue = 0;

const int pinLedKuning = 14;
const int pinLedHijau = 13;
const int pinLedMerah = 12;

void setup() {
  Serial.begin(115200);
  randomSeed(analogRead(0));

  delay(10);
  Serial.println();
  Serial.print("Terkoneksi Ke");
  Serial.println(ssid);

  WiFiConnect();

  Serial.println("");
  Serial.println("WiFi Terkoneksi");
  Serial.println("IP address: ");
  Serial.println(WiFi.localIP());
  Serial.println(WiFi.macAddress());
  stMac = WiFi.macAddress();
  stMac.replace(":", "_");
  Serial.println(stMac);

  client.setServer(mqttServer, port);
  client.setCallback(callback);
  pinMode(pinLedKuning, OUTPUT);
  pinMode(pinLedHijau, OUTPUT);
  pinMode(pinLedMerah, OUTPUT);

}

void WiFiConnect(){
  WiFi.mode(WIFI_STA);
  WiFi.begin(ssid, password);
  while (WiFi.status() != WL_CONNECTED){
    delay(500);
    Serial.print(".");
  }
}

void mqttReconnect(){
  while (!client.connected()){
    Serial.println("Menghubungkan Koneksi MQTT");
    long data = random(1000);
    sprintf(clientId, "clientId-%Id", data);
    if (client.connect(clientId)){
      Serial.print(clientId);
      Serial.println(" Terkoneksi ");
      client.subscribe("Adi/projectkomputervision1803");

    }else{
      Serial.print(" Gagal Terkoneksi");
      Serial.print(client.state());
      Serial.println(" Tunggu waktu sampai 5 detik");
      delay(5000);
    }
  }
}

void callback(char* topic, byte* message, unsigned int length){

  Serial.print("Pesan Yang diterima[");
  Serial.print(topic);
  Serial.print("]");
  for(int i = 0;i<length;i++){
    Serial.print((char)message[i]);
  }
  Serial.println("");
  if((char)message[0] == '1'){
    ledMerahON();
  }
  else if((char)message[0] == '0') {
    ledMerahOFF();  
  }
    if((char)message[1] == '1'){
    ledHijauON();
  }
  else if((char)message[1] == '0'){
    ledHijauOFF();
  }
  if((char)message[2] == '1'){
    ledKuningON();
  }
  else if((char)message[2] == '0'){
    ledKuningOFF();
  }
  
}

void ledKuningON(){
  digitalWrite(pinLedKuning, HIGH);
}

void ledKuningOFF(){
  digitalWrite(pinLedKuning, LOW);
}

void ledHijauON(){
  digitalWrite(pinLedHijau, HIGH);
}

void ledHijauOFF(){
  digitalWrite(pinLedHijau, LOW);
}
void ledMerahON(){
  digitalWrite(pinLedMerah, HIGH);
}
void ledMerahOFF(){
  digitalWrite(pinLedMerah, LOW);
}

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