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

HCSR04 hc(2, 4); //initialisation class HCSR04 (trig pin , echo pin)
int led = 15;

// Ganti dengan broker MQTT
const char* ssid = "Wokwi-GUEST";
const char* password = "";
const char* mqtt_server = "broker.emqx.io";

WiFiClient espClient;
PubSubClient client(espClient);
char perintah;

void reconnect() {
  while (!client.connected()) {
    Serial.print("Menghubungkan ke MQTT...");
    if (client.connect("ESP32Client-komang12345!%%")) {
      Serial.println("terhubung!");
      client.subscribe("/project/lampukamar/");  
    } else {
      Serial.print("Gagal, rc=");
      Serial.print(client.state());
      Serial.println(" coba lagi dalam 5 detik");
      delay(5000);
    }
  }
}


void setup()
{
  WiFi.begin(ssid, password, 6);
  Serial.print("Menghubungkan ke WiFi...");
  while (WiFi.status() != WL_CONNECTED) {
    delay(500);
    Serial.print(".");
  }
  Serial.println(" terhubung!");

  client.setServer(mqtt_server, 1883);
  client.setCallback(callback);

  Serial.begin(115200);
  pinMode(led, OUTPUT);
}

void loop()
{
  float jarak = hc.dist();
  if(jarak < 30)
  {
    //digitalWrite(led, HIGH);
  }
  else
  {
    //digitalWrite(led, LOW);
  }


  if (!client.connected()) {
    reconnect();
  }
  client.loop();

  if(perintah == '1')
  {
    digitalWrite(led, HIGH);
  }
  else if(perintah == '0')
  {
    digitalWrite(led, LOW);
  }
  
  String dataJarak = String(jarak);
  client.publish("stikombali/data/jarak", dataJarak.c_str());

  Serial.println(jarak); // return curent distance in serial
  delay(60);                 // we suggest to use over 60ms measurement cycle, in order to prevent trigger signal to the echo signal.
}

void callback(char* topic, byte* payload, unsigned int length) {
  Serial.print("Pesan diterima [");
  Serial.print(topic);
  Serial.print("] ");
  for (int i = 0; i < length; i++) {
    Serial.print((char)payload[i]);
  }
  Serial.println();
  
  if (length > 0) {
    perintah = (char)payload[0];  
    Serial.println(perintah);
  }
}