#include <WiFi.h>
const char *ssid = "Wokwi-GUEST"; 
const char *password = "";  

// MQTT Broker
#include <PubSubClient.h>
const char *mqtt_broker = "mqtt.egrotek.id";
String topic_custom_publish = "egrotek/pub/APPFq3jMwvaFc5HlihKzG/DEVAFSidTpuIp965UxAMg";
String topic_custom_subscribe = "egrotek/sub/APPFq3jMwvaFc5HlihKzG/DEVAFSidTpuIp965UxAMg";
const char *mqtt_username = "mswUEUEsvXMAxHAwgD";
const char *mqtt_password = "YBS8tb2ZhlG7dnIYE9";
int mqtt_port = 1883;
const char *client_id = "DEVAFSidTpuIp965UxAMg";

WiFiClient espClient;
PubSubClient client(espClient);
// SENSOR
#define TRIG_PIN   14
#define ECHO_PIN   32 
#define DISTANCE_THRESHOLD 50 //cm
long panjang = 0;
int pesan ;
float duration_us, distance_cm;
String val_distance_cm = "level";

void setup() {
  // Set software serial baud to 9600;
  Serial.begin(9600);
  // connecting to a WiFi network
  Serial.print("Conecting to wifi AP");
  WiFi.begin(ssid, password);
  while (WiFi.status() != WL_CONNECTED) {
      delay(500);
      Serial.print(".");
  }
    Serial.println("");
  Serial.println("WiFi connected");
  Serial.println("IP address: ");
  Serial.println(WiFi.localIP());
  //connecting to a mqtt broker
  client.setServer(mqtt_broker, mqtt_port);
  client.setCallback(callback);
  while (!client.connected()) {
      Serial.printf("The client %s connects to the public mqtt broker\n", client_id);
      if (client.connect(client_id, mqtt_username, mqtt_password)) {
          Serial.println("Public emqx mqtt broker connected");
      } else {
          Serial.print("failed with state ");
          Serial.print(client.state());
          delay(2000);}
  }
  // publish and subscribe
     char finalsubs[topic_custom_subscribe.length() + 1];
     topic_custom_subscribe.toCharArray(finalsubs, topic_custom_subscribe.length()+ 1);
      client.subscribe(finalsubs);
  // DHT 
  pinMode(TRIG_PIN, OUTPUT);  
  pinMode(ECHO_PIN, INPUT);  
    }
void callback(char *topic2, byte *payload, unsigned int length) {
    Serial.print("Message arrived in topic: ");
    Serial.println(topic2);
    Serial.print("Message:");
    for (int i = 0; i < length; i++) {
        Serial.print((char) payload[i]);}
    Serial.println();
    Serial.println("-----------------------");}
void reconnect() {
  // Loop until we're reconnected
  while (!client.connected()) {
    Serial.print("Attempting MQTT connection...");
    // Attempt to connect
    if (client.connect(client_id, mqtt_username, mqtt_password)) {
      Serial.println("connected");
      // Subscribe
 //     client.subscribe(topic_custom_publish);
       char finalsubs[topic_custom_subscribe.length() + 1];
      topic_custom_subscribe.toCharArray(finalsubs, topic_custom_subscribe.length() + 1);
      client.subscribe(finalsubs);
          } else {
      Serial.print("failed, rc=");
      Serial.print(client.state());
      Serial.println(" try again in 5 seconds");
      // Wait 5 seconds before retrying
      delay(5000);}}
}

void loop() {
if (!client.connected()) {
    reconnect();
  }
  client.loop();
  long now = millis();
  if (now - panjang > 5000) {
     panjang = now;

  digitalWrite(TRIG_PIN, HIGH);
  delayMicroseconds(10);
  digitalWrite(TRIG_PIN, LOW);
  duration_us = pulseIn(ECHO_PIN, HIGH);
  distance_cm = 0.017 * duration_us;


  Serial.print("distance: ");
  Serial.print(distance_cm);
  Serial.println(" cm");
   String pesan = "{\"" + val_distance_cm + "\":\"" + String(distance_cm, 1)  + "\"}";
   Serial.println(pesan);
      char finalDataChar[pesan.length() + 1];
      char topicChar[topic_custom_publish.length() + 1];
      pesan.toCharArray(finalDataChar, pesan.length() + 1);
      topic_custom_publish.toCharArray(topicChar, topic_custom_publish.length()+1);
      client.publish(topicChar, finalDataChar);
   
  }
 }