#include <WiFi.h>
#include <WiFiMulti.h>
#include <stdio.h>
#include <stdbool.h>
#include <esp_err.h>
#include "PubSubClient.h"


#include "Ultrasonic.h"
const int DISTANCE_THRESHOLD = 12; // meters
Ultrasonic ultrasonic(5, 4);

// variables will change:
int distance;

const char* ssid = "Wokwi-GUEST";
const char* pass = "";
const char* mqttServer = "0.tcp.ap.ngrok.io";
int port = 12409;
String stMac;
char mac[50];
char clientId[50];
unsigned long lastMsg = 0;
#define MSG_BUFFER_SIZE (50)
char msg[MSG_BUFFER_SIZE];
int value = 0;

WiFiClient espClient;
PubSubClient client(espClient);

int buzzer = 18;
int switchleft = 25;
int switchright = 26;

void setup() {
  Serial.begin (9600);       // initialize serial port
  pinMode(buzzer, OUTPUT);
  Serial.begin(115200);
  randomSeed(analogRead(0));

  WiFi.mode(WIFI_STA);
  WiFi.begin(ssid, pass);
  while (WiFi.status() != WL_CONNECTED) {

    delay(100);
    Serial.println("connecting. . .");
    Serial.println(ssid);

    wifiConnect();

    Serial.println("WiFi Connected");
    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(buzzer, OUTPUT);
  }
}

void wifiConnect() {
  WiFi.mode(WIFI_STA);
  WiFi.begin(ssid, pass);
  while (WiFi.status() != WL_CONNECTED) {
    delay(500);
    Serial.println(".");
  }
}

void mqttReconnect() {
  while (!client.connected()) {
    Serial.print("Attempting MQTT connection...");
    // perintah membuat client id agar mqtt broker mengenali board yang kita gunakan
    String clientId = "ESP32Client-";
    clientId += String(random(0xffff), HEX);
    // Attempt to connect
    if (client.connect(clientId.c_str())) {
      Serial.println("Connected");
      // Once connected, publish an announcement...
      client.publish("tower", "Home"); //perintah publish data ke alamat topik yang di setting
      // ... and resubscribe
      client.subscribe("tower"); //perintah subscribe data ke mqtt broker
    } else {
      Serial.print("failed, rc=");
      Serial.print(client.state());
      Serial.println(" try again in 5 seconds");
      // Wait 5 seconds before retrying
      delay(5000);
    }
  }
}

void callback(char* topic, byte* payload, unsigned int length) { //perintah untuk menampilkan data ketika esp32 di setting sebagai subscriber
  Serial.print("Message arrived [");
  Serial.print(topic);
  Serial.print("] ");
  for (int i = 0; i < length; i++) { //mengecek jumlah data yang ada di topik mqtt
    Serial.print((char)payload[i]);
  }
  Serial.println();

  // Switch on the LED if an 1 was received as first character
  if ((char)payload[0] == '1') {
    digitalWrite(2, LOW);   // Turn the LED on (Note that LOW is the voltage level
    // but actually the LED is on; this is because
    // it is active low on the ESP-01)
  } else {
    digitalWrite(2, HIGH);  // Turn the LED off by making the voltage HIGH
  }
}

void loop() {
  if (!client.connected()) {
    mqttReconnect();
  }
  client.loop();
  distance = ultrasonic.read(CM);  

  if (distance < DISTANCE_THRESHOLD){
    tone(buzzer, 18); // Turn Buzzer On
    noTone(buzzer);
    delay (500);
    tone(buzzer, 256, 1000);
    Serial.print("Gerak terdeteksi pada jarak : ");
    Serial.print(distance);
    Serial.println(" m");
    delay(1500);
  }
    else{
    noTone(buzzer);  // Turn Buzzer Off

    // print the value to Serial Monitor
    Serial.print("Situasi : Terpantau Aman ");
    delay(1500);
    }

    unsigned long now = millis();
    if (now - lastMsg > 2000) { //perintah publish data
    lastMsg = now;
    snprintf (msg, MSG_BUFFER_SIZE, "%ld", distance); //perintah mempersiapkan data untuk dikirim ke mqtt broker
    Serial.print("Publish message: ");
    Serial.println(msg);
    client.publish("tower", msg); //perintah publish data ke mqtt broker, yang di publish data dalam variabel msg boleh diubah-ubah
  }
}