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

WiFiClient espClient;
PubSubClient mqttClient(espClient);

const char *ssid = "Wokwi-GUEST";
const char *password = "";
const char *mqttBroker = "iot.egrotek.id";
const char *mqttPubTopic = "egrotek/pub/APPmI3YgR3vfymCfa04ET/DEVnHAtKNmfiEkbV1GZAj";
const char *mqttSubTopic = "egrotek/sub/APPmI3YgR3vfymCfa04ET/DEVnHAtKNmfiEkbV1GZAj";
const char *mqttID = "DEVnHAtKNmfiEkbV1GZAj";
const char *mqttUser = "ph0CMhmhF1NsPjSDKN";
const char *mqttPass = "RZtPsrEIfXDCFTJRm3";
uint16_t mqttPort = 1883;

// LED pins
const int ledPin1 = 2;
const int ledPin2 = 4;
int ledState1 = LOW;
int ledState2 = LOW;

void setup() {
  Serial.begin(9600);
  pinMode(ledPin1, OUTPUT); // Set LED pin1 as OUTPUT
  pinMode(ledPin2, OUTPUT); // Set LED pin2 as OUTPUT

  // Connect to WiFi
  Serial.print("Connecting to WiFi...");
  WiFi.begin(ssid, password);
  while (WiFi.status() != WL_CONNECTED) {
    delay(500);
    Serial.print(".");
  }
  Serial.println("WiFi connected.");
  Serial.print("IP address: ");
  Serial.println(WiFi.localIP());

  // Set up MQTT
  mqttClient.setServer(mqttBroker, mqttPort);
  mqttClient.setCallback(callback);

  // Connect to MQTT broker
  reconnect();
}

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

  // Toggle LED states
  ledState1 = !ledState1; // Toggle LED1 state
  ledState2 = !ledState2; // Toggle LED2 state
  digitalWrite(ledPin1, ledState1); // Apply state to LED1 pin
  digitalWrite(ledPin2, ledState2); // Apply state to LED2 pin

  // Print LED statuses
  Serial.print("LED1 State: ");
  Serial.println(ledState1);
  Serial.print("LED2 State: ");
  Serial.println(ledState2);

  // Create JSON payload
  String data = "{\"led1\":" + String(ledState1) + ", \"led2\":" + String(ledState2) + "}";
  char payload[50];
  data.toCharArray(payload, 50);

  // Publish LED statuses to MQTT
  mqttClient.publish(mqttPubTopic, payload);

  delay(1000); // Delay between readings
}

void reconnect() {
  // Loop until we're reconnected
  while (!mqttClient.connected()) {
    Serial.print("Attempting MQTT connection...");
    // Attempt to connect
    if (mqttClient.connect(mqttID, mqttUser, mqttPass)) {
      Serial.println("connected");
      mqttClient.subscribe(mqttSubTopic);
    } else {
      Serial.print("failed, rc=");
      Serial.print(mqttClient.state());
      Serial.println(" try again in 5 seconds");
      delay(5000);
    }
  }
}

void callback(char* topic, byte* payload, unsigned int length) {
  // Handle incoming messages here if needed
}