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

const char* ssid = "Wokwi-GUEST";
const char* password = "";

StaticJsonDocument<256> jsonDocument;

WiFiClient espClient;
PubSubClient client(espClient);
unsigned long lastMsg = 0;
#define MSG_BUFFER_SIZE (500)
char msg[MSG_BUFFER_SIZE];
int value = 0;

GPS gps;

String tempTimestamp = "";

String uid;
const char* mqtt_broker = "test.mosquitto.org";
const char deviceId[] = "";
const char publishPath[] = "/cycling";
char subscribePath[20];

void setup_wifi() {  //perintah koneksi wifi
  delay(10);
  // We start by connecting to a WiFi network
  Serial.println();
  Serial.print("Connecting to ");
  Serial.println(ssid);

  WiFi.mode(WIFI_STA);         //setting wifi chip sebagai station/client
  WiFi.begin(ssid, password);  //koneksi ke jaringan wifi

  while (WiFi.status() != WL_CONNECTED) {  //perintah tunggu esp32 sampi terkoneksi ke wifi
    delay(500);
    Serial.print(".");
  }

  randomSeed(micros());

  Serial.println("");
  Serial.println("WiFi connected");
  Serial.println("IP address: ");
  Serial.println(WiFi.localIP());
}

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

  deserializeJson(doc, value);
  JsonObject object = doc.as<JsonObject>();
  String uidObject = object["uid"];

  if (strcmp(topic, subscribePath) == 0) {
    if (uid != uidObject) {
      uid = uidObject;
    }
    delay(15);
  }  /// esp32 subscribe topic
}

void reconnect() {  //perintah koneksi esp32 ke mqtt broker baik itu sebagai publusher atau subscriber
  // Loop until we're reconnected
  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(), "rw", "readwrite")) {
      Serial.println("Connected");
      client.subscribe(subscribePath);  //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 setup() {
  pinMode(2, OUTPUT);
  Serial.begin(115200);

  gps.setupGPS();

  strcpy(subscribePath, publishPath);
  strcat(subscribePath, deviceId);

  setup_wifi();
  client.setServer(mqtt_broker, 1884);
  client.setCallback(callback);
}

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

  delay(100);

  GPSData gps_coordinates;

  if (gps.getGPS(gps_coordinates)) {
      Serial.print("Latitude= ");
      Serial.print(gps_coordinates.latitude);
      Serial.print(" Longitude= ");
      Serial.println(gps_coordinates.longitude);
      Serial.print(" Timestamp= ");
      Serial.print(gps_coordinates.timestamp);
      Serial.print(" speed= ");
      Serial.println(gps_coordinates.speed);
  }

  publishMQTT(gps_coordinates);
}

void publishMQTT(GPSData gpsData) {
  if (!gpsData.timestamp.equals(tempTimestamp)) {
    tempTimestamp = gpsData.timestamp;
    if(gpsData.latitude != "0.000000" && gpsData.longitude != "0.000000") {
      jsonDocument["long"] = gpsData.longitude;
      jsonDocument["lat"] = gpsData.latitude;
      jsonDocument["timestamp"] = gpsData.timestamp;
    }
  }

  // jsonDocument["uid"] = uid;

  char jsonBuffer[256];
  serializeJson(jsonDocument, jsonBuffer);

  // if (uid != "") {
  //   client.publish("/tracker-gps", jsonBuffer);
  // }
  client.publish("/cycling", jsonBuffer);
}