#include <WiFi.h>
#include <WiFiClientSecure.h>
#include <PubSubClient.h>
#include <Arduino_JSON.h>
#include <ESP32Servo.h>

// Pin untuk LED dan servo
#define SERVO_PIN 18
#define LED_PIN 4    

const char ssid[] = "Wokwi-GUEST";
const char pass[] = "";
const char *mqttServer = "j31faa13.ala.asia-southeast1.emqxsl.com";
const char *topic_temperature = "monitoring/sensor/kelembapan";
const char *topic_humidity = "monitoring/sensor/suhu";
const char *topic_light = "monitoring/sensor/cahaya";
const char *mqtt_username = "mentoring-12";
const char *mqtt_password = "mentoring12";
int port = 8883;

unsigned long lastTime = 0;
unsigned long intervalTime = 1000;
float temperature, humidity; 
int lightValue; 

Servo servo;

WiFiClientSecure espClient;
PubSubClient client(espClient);

static const char *root_ca PROGMEM = R"EOF(
-----BEGIN CERTIFICATE-----
MIIDrzCCApegAwIBAgIQCDvgVpBCRrGhdWrJWZHHSjANBgkqhkiG9w0BAQUFADBh
MQswCQYDVQQGEwJVUzEVMBMGA1UEChMMRGlnaUNlcnQgSW5jMRkwFwYDVQQLExB3
d3cuZGlnaWNlcnQuY29tMSAwHgYDVQQDExdEaWdpQ2VydCBHbG9iYWwgUm9vdCBD
QTAeFw0wNjExMTAwMDAwMDBaFw0zMTExMTAwMDAwMDBaMGExCzAJBgNVBAYTAlVT
MRUwEwYDVQQKEwxEaWdpQ2VydCBJbmMxGTAXBgNVBAsTEHd3dy5kaWdpY2VydC5j
b20xIDAeBgNVBAMTF0RpZ2lDZXJ0IEdsb2JhbCBSb290IENBMIIBIjANBgkqhkiG
9w0BAQEFAAOCAQ8AMIIBCgKCAQEA4jvhEXLeqKTTo1eqUKKPC3eQyaKl7hLOllsB
CSDMAZOnTjC3U/dDxGkAV53ijSLdhwZAAIEJzs4bg7/fzTtxRuLWZscFs3YnFo97
nh6Vfe63SKMI2tavegw5BmV/Sl0fvBf4q77uKNd0f3p4mVmFaG5cIzJLv07A6Fpt
43C/dxC//AH2hdmoRBBYMql1GNXRor5H4idq9Joz+EkIYIvUX7Q6hL+hqkpMfT7P
T19sdl6gSzeRntwi5m3OFBqOasv+zbMUZBfHWymeMr/y7vrTC0LUq7dBMtoM1O/4
gdW7jVg/tRvoSSiicNoxBN33shbyTApOB6jtSj1etX+jkMOvJwIDAQABo2MwYTAO
BgNVHQ8BAf8EBAMCAYYwDwYDVR0TAQH/BAUwAwEB/zAdBgNVHQ4EFgQUA95QNVbR
TLtm8KPiGxvDl7I90VUwHwYDVR0jBBgwFoAUA95QNVbRTLtm8KPiGxvDl7I90VUw
DQYJKoZIhvcNAQEFBQADggEBAMucN6pIExIK+t1EnE9SsPTfrgT1eXkIoyQY/Esr
hMAtudXH/vTBH1jLuG2cenTnmCmrEbXjcKChzUyImZOMkXDiqw8cvpOp/2PV5Adg
06O/nVsJ8dWO41P0jmP6P6fbtGbfYmbW0W5BjfIttep3Sp+dWOIrWcBAI+0tKIJF
PnlUkiaY4IBIqDfv8NZ5YBberOgOzW6sRBc4L0na4UU+Krk2U886UAb3LujEV0ls
YSEY1QSteDwsOoBrp+uvFRTp2InBuThs4pFsiv9kuXclVzDAGySj4dzp30d8tbQk
CAUw7C29C79Fv1C5qfPrmAESrciIxpg0X40KPMbp1ZWVbd4=
-----END CERTIFICATE-----
)EOF";

void setup() {
  Serial.begin(115200);
  wifi_init();
  mqtt_init();
  servo.attach(SERVO_PIN); 
}

void loop() {
  client.loop();
  if (!client.connected()) {
    mqtt_init();
  }
  send_data();
  control_actuator();
  process_command();
}

void wifi_init() {
  Serial.print("Connecting to WiFi");
  WiFi.begin(ssid, pass, 6);
  while (WiFi.status() != WL_CONNECTED) {
    delay(100);
    Serial.print(".");
  }
  Serial.println(" Connected!");
}

void mqtt_init() {
  espClient.setCACert(root_ca);
  client.setServer(mqttServer, port);
  client.setCallback(callback);
  while (!client.connected()) {
    String client_id = "mentoring-iot-3-";
    client_id += String(WiFi.macAddress());
    Serial.printf("The client %s connects to the public MQTT broker\n", client_id.c_str());
    if (client.connect(client_id.c_str(), mqtt_username, mqtt_password)) {
      Serial.println("Public EMQX MQTT broker connected");
      client.subscribe(topic_temperature);
      client.subscribe(topic_humidity);
      client.subscribe(topic_light);
    } else {
      Serial.print("failed with state ");
      Serial.print(client.state());
      delay(2000);
    }
  }
}

void callback(char *topic, byte *payload, unsigned int length) {
  String message;
  for (int i = 0; i < length; i++) {
    message += (char)payload[i];
  }
  if (strcmp(topic, topic_temperature) == 0) {
    temperature = message.toFloat();
  } else if (strcmp(topic, topic_humidity) == 0) {
    humidity = message.toFloat();
  } else if (strcmp(topic, topic_light) == 0) {
    lightValue = message.toInt();
  }
}

void control_actuator() {
  // Tidak ada kontrol aktuator di sini karena akan dikendalikan melalui Serial Monitor
}

void send_data() {
  Serial.print("Temperature: ");
  Serial.print(temperature);
  Serial.println(" °C");
  Serial.print("Humidity: ");
  Serial.print(humidity);
  Serial.println(" %");
  Serial.print("Light Value: ");
  Serial.println(lightValue);
}

void process_command() {
  if (Serial.available() > 0) {
    char command = Serial.read();
    if (command == 's') {
      servo.write(90); // Putar servo ke posisi tengah (90 derajat)
      Serial.println("Servo is set to 90 degrees");
    } else if (command == 'r') {
      servo.write(0); // Putar servo ke posisi awal (0 derajat)
      Serial.println("Servo is reset to 0 degrees");
    } else if (command == '1') {
      digitalWrite(LED_PIN, HIGH); // Hidupkan LED
      Serial.println("LED is turned ON");
    } else if (command == '0') {
      digitalWrite(LED_PIN, LOW); // Matikan LED
      Serial.println("LED is turned OFF");
    } else {
      Serial.println("Invalid command");
    }
  }
}