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

const char *mqttServer = "vcc110a1.ala.asia-southeast1.emqxsl.com"; // host
const char *topic = "iot1/tugasP13"; // Rest API: endpoint

const char *mqtt_username = "MentoringP12";
const char *mqtt_password = "Arin4321";
int port = 8883;

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";

const int servoPin = 18;
const int ledPin = 4;

Servo myservo;
WiFiClientSecure espClient;
PubSubClient client(espClient);

void mqtt_init();
void processData();

void callback(char *topic, byte *payload, unsigned int length) {
  String sMsg;
  Serial.print("Message arrived in topic: ");
  Serial.println(topic);
  Serial.print("Message:");

  // perulanag/ looping
  for (int i = 0; i < length; i++) {
    Serial.print((char) payload[i]);
    sMsg += (char) payload[i];
  }

  Serial.println(sMsg);

  JSONVar objMsg = JSON.parse(sMsg);

  processData(objMsg);

  Serial.println();
  Serial.println("-----------------------");
}

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

  WiFi.begin("Wokwi-GUEST", "");

  Serial.print("Connecting");
  while (WiFi.status() != WL_CONNECTED) {
    delay(100);
    Serial.print('.');
  }
  Serial.println("Connected");

  espClient.setCACert(root_ca);
  client.setServer(mqttServer, port);
  client.setCallback(callback);

  while (!client.connected()) {
    mqtt_init();
  }

  myservo.attach(servoPin);
  myservo.write(0);

  pinMode(ledPin, OUTPUT);
}

void loop() {
  client.loop();

  if (!client.connected()) {
    mqtt_init();
  }
}

void mqtt_init() {
  espClient.setCACert(root_ca);
  client.setServer(mqttServer, port);
  client.setCallback(callback);

  while (!client.connected()) {
    String client_id = "sub-esp32-iot-6-";
    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);
    } else {
      Serial.print("failed with state ");
      Serial.print(client.state());
      delay(2000);
    }
  }
}