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

#define TRIG_PIN 18
#define ECHO_PIN 5
#define LED1 12
#define LED2 13

const char *ssid = "Wokwi-GUEST";
const char *password = "";
const char *mqtt_server = "broker.mqtt-dashboard.com";

float waterLevel; // Variabel global untuk menyimpan tinggi air

// Queue untuk komunikasi dan sinkronisasi data antara taskUkurJarak dan taskWifiMQTT

LiquidCrystal_I2C lcd(0x27, 16, 2);
WiFiClient espClient;
PubSubClient client(espClient);
QueueHandle_t integerQueue;


void taskUkurJarak(void *pvParameters) {
  (void)pvParameters;

  pinMode(TRIG_PIN, OUTPUT);
  pinMode(ECHO_PIN, INPUT);
   pinMode(LED1, OUTPUT);
  pinMode(LED2, OUTPUT);

  for (;;) {
    digitalWrite(TRIG_PIN, LOW);
    delayMicroseconds(2);
    digitalWrite(TRIG_PIN, HIGH);
    delayMicroseconds(10);
    digitalWrite(TRIG_PIN, LOW);

    long duration = pulseIn(ECHO_PIN, HIGH);
    float distance = (duration * 0.0343) / 2;

    waterLevel = 400 - distance;

    if ((waterLevel >= 0) && (waterLevel < 300)) {
      digitalWrite(LED1, HIGH);
      digitalWrite(LED2, LOW);
    } else {
      digitalWrite(LED2, HIGH);
      digitalWrite(LED1, LOW);
    }
    vTaskDelay(1000 / portTICK_PERIOD_MS);
  }
}

void taskWiFiMQTT(void *pvParameters) {
  (void)pvParameters;

  while (WiFi.status() != WL_CONNECTED) {
    Serial.println("Connecting to WiFi...");
    WiFi.begin(ssid, password);
    vTaskDelay(2000 / portTICK_PERIOD_MS);
  }
  Serial.println("WiFi connected");
  Serial.println("IP address: ");
  Serial.println(WiFi.localIP());

  client.setServer(mqtt_server, 1883);

  while (!client.connected()) {
    Serial.println("Connecting to MQTT...");
    String clientId = "ESP32Client-";
    clientId += String(random(0xffff), HEX);
    if (client.connect(clientId.c_str())) {
      Serial.println("Connected to MQTT");
    } else {
      Serial.print("Failed to connect to MQTT, rc=");
      Serial.print(client.state());
      Serial.println(" retrying in 5 seconds");
      vTaskDelay(5000 / portTICK_PERIOD_MS);
    }

    for (;;) {
      client.loop();
      client.publish("monitoring/tinggiair/node1", String(waterLevel).c_str());
      vTaskDelay(1000 / portTICK_PERIOD_MS);
    }
  }

  for (;;) {
    client.loop();
    vTaskDelay(10 / portTICK_PERIOD_MS);
  }
}

void setup() {
  Serial.begin(9600);

  integerQueue  = xQueueCreate(1, sizeof(float));

  // Buat dan jalankan task sesuai dengan prioritas
  xTaskCreate(taskUkurJarak, "UkurJarak", 4096, NULL, 1, NULL);
  xTaskCreate(taskWifiMQTT, "WifiMQTT", 4096, NULL, 2, NULL); 
}

void loop() {
  vTaskDelete(NULL);
}