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

// Setting Awal MQTT
char *mqttServer = "broker.emqx.io";
int mqttPort = 1883;
String myClientID = "001";
String Topic_1 = "iqbal/iot/jarak";

//Membuat Object MQTT Client dan Jenis Koneksi
WiFiClient wifi;
PubSubClient mqttClient(wifi);

char* ssid = "Wokwi-GUEST";
char* pass = "";

//pinsensor jarak
#define PIN_TRIG 18
#define PIN_ECHO 19

void setup() {
  // put your setup code here, to run once:
  Serial.begin(115200);
  WiFi.mode(WIFI_STA);    // Agar ESP32 menjadi mode Station
  WiFi.begin(ssid,pass);  // Meminta ESP untuk connect
  while(WiFi.status() != WL_CONNECTED){
    delay(100);
    Serial.println("*");
  }
  Serial.println(" ESP 32 telah berhasil Connect");
  // Memerintahkan EPS untuk tahu alamat broker
  init_to_broker(mqttServer, mqttPort); 
  //Memerintahkan untuk Connect ke Broker
  connect_to_broker(myClientID);


  pinMode(PIN_TRIG, OUTPUT);
  pinMode(PIN_ECHO, INPUT);
}

void loop() {

  //memulai sensor jarak
  digitalWrite(PIN_TRIG, HIGH);
  delayMicroseconds(10);
  digitalWrite(PIN_TRIG, LOW);
  //menghitung jarak
  int duration = pulseIn(PIN_ECHO, HIGH);
  int jarak = (duration / 58);

  mqtt_publish(Topic_1, jarak);
  delay(100);
}


void init_to_broker(char* myMqttServer, int myMqttPort) {
  mqttClient.setServer(myMqttServer, myMqttPort); // Mengatur detail broker target  yang digunakan
  // jika kita ingin menerima pesan untuk langganan yang dibuat oleh klien sebagai subscriber
  // mqttClient.setCallback(callback);           
}

void connect_to_broker(String clientName) {
  Serial.println("Connecting to MQTT Broker...");
  String clientId = "ESP32Client-" + clientName;
  mqttClient.connect(clientId.c_str()); // Connecting to Broker
  while (!mqttClient.connected()) {
      Serial.print("failed, rc=");
      Serial.println(mqttClient.state());
      Serial.println("Reconnecting to MQTT Broker..");
      delay(1000);  
  }
  Serial.print(clientId);
  Serial.println(" Device to Broker Connected.");
}

void mqtt_publish(String yourTopic, float yourPayload){
  char yourPayloadString[15];
  sprintf(yourPayloadString, "jarak adalah: %.2f", yourPayload); // Combine string and payload
  mqttClient.publish(yourTopic.c_str(), yourPayloadString);
  Serial.print(yourTopic);
  Serial.print(" ==> ");
  Serial.println(yourPayload);
}