#include <PubSubClient.h>
#include <WiFi.h>
#include "ThingsBoard.h"
#include "DHTesp.h"
#include <LiquidCrystal_I2C.h>

#define MQTT_TOPIC "onOFF"
#define ID_MQTT "micropython-weather-demo"

const char *SSID = "Wokwi-GUEST"; 
const char *PASSWORD = "";    

const char *BROKER_MQTT = "broker.mqttdashboard.com";
int BROKER_PORT = 1883;
int butt=0;

WiFiClient espClient;        
PubSubClient MQTT(espClient);

const byte buzz_Pin = 19;
const byte trig_Pin = 26;
const byte echo_Pin = 25;
const byte pir_Pin = 27;

//buzzer
int freqB   =900;
int chan1B  =0;
int resoB   =8;
int dutyCycleB = 128;

//ultrasonic sensor
float waktu, jarak;

int pirSensor = digitalRead(pir_Pin);

void initWiFi(void);
void initMQTT(void);
void callbackMQTT(char *topic, byte *payload, unsigned int length);
void reconnectMQTT(void);
void reconnectWiFi(void);
void checkWiFIAndMQTT(void);

void initWiFi(void)
{
  delay(10);
  Serial.println("------Conexao WI-FI------");
  Serial.print("Conectando-se na rede: ");
  Serial.println(SSID);
  Serial.println("Aguarde");

  reconnectWiFi();
}

void initMQTT(void)
{
  MQTT.setServer(BROKER_MQTT, BROKER_PORT);
  MQTT.setCallback(callbackMQTT);          
}

void callbackMQTT(char *topic, byte *payload, unsigned int length)
{
  String msg;

  // Obtem a string do payload recebido
  for (int i = 0; i < length; i++) {
    char c = (char)payload[i];
    msg += c;
  }
  Serial.printf("Chegou a seguinte string via MQTT: %s do topico: %s\n", msg, topic);

  /* Toma ação dependendo da string recebida */
  if (msg.equals("1")) {
    Serial.println("Nyalakan sistem");
    pirSensor=1;
    
  }

  else if (msg.equals("0")) {
    Serial.println("Matikan sistem");
   pirSensor=0;
   
  }
}

void reconnectMQTT(void)
{
  while (!MQTT.connected()) {
    Serial.print("* Tentando se conectar ao Broker MQTT: ");
    Serial.println(BROKER_MQTT);
    if (MQTT.connect(ID_MQTT)) {
      Serial.println("Conectado com sucesso ao broker MQTT!");
      MQTT.subscribe(MQTT_TOPIC);
    } else {
      Serial.println("Falha ao reconectar no broker.");
      Serial.println("Nova tentativa de conexao em 2 segundos.");
      delay(2000);
    }
  }
}

void checkWiFIAndMQTT(void)
{
  if (!MQTT.connected())
    reconnectMQTT(); // se não há conexão com o Broker, a conexão é refeita

  reconnectWiFi(); // se não há conexão com o WiFI, a conexão é refeita
}

void reconnectWiFi(void)
{
  // se já está conectado a rede WI-FI, nada é feito.
  // Caso contrário, são efetuadas tentativas de conexão
  if (WiFi.status() == WL_CONNECTED)
    return;

  WiFi.begin(SSID, PASSWORD); // Conecta na rede WI-FI

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

  Serial.println();
  Serial.print("Conectado com sucesso na rede ");
  Serial.print(SSID);
  Serial.println("IP obtido: ");
  Serial.println(WiFi.localIP());
}

void jalan(){
waktu = pulseIn(echo_Pin, HIGH);
  jarak = 0.017 * waktu;

  if(pirSensor == 1){
    Serial.println("=== Gerakan Terdeteksi ===");
    ledcWrite(chan1B, dutyCycleB);
    delay(300);

    if(jarak < 399){
      Serial.print("=== JARAK : ");
      Serial.print(jarak);
      Serial.println(" cm ===");
      delay(300);
    }else{
      Serial.print("=== JARAK LEBIH DARI ");
      Serial.print(jarak);
      Serial.println(" cm ===");
      delay(300);
    }
    //String message= "antoy";
    //  Serial.print("Updated!");
    //Serial.print("Reporting to MQTT topic {}: {}".(MQTT_TOPIC, message))
  // espClient(MQTT_TOPIC, message);
  }else{
      Serial.println(" ~Tidak Ada Gerakan~ ");
      ledcWrite(chan1B, 0);
      (jarak = 0);
      delay(1000);
    }
}

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

  pinMode(trig_Pin, OUTPUT);
  pinMode(echo_Pin, INPUT);
  pinMode(pir_Pin, INPUT_PULLUP);

  ledcSetup(chan1B, freqB, resoB);
  ledcAttachPin(buzz_Pin, chan1B);

  initWiFi();

 
  initMQTT();
}

void loop(){

  digitalWrite(trig_Pin, HIGH);
  delayMicroseconds(100);
  digitalWrite(trig_Pin, LOW);

  jalan();
  checkWiFIAndMQTT();

   
  MQTT.loop();
}