#include <WiFi.h>
#include <PubSubClient.h>
#include <ArduinoJson.h> // Inclua a biblioteca ArduinoJson
#include "DHTesp.h"

//Configurações WiFi
const char* ssid = "Wokwi-GUEST";
const char* password = "";

//Configurações do ThingsBoard
const char* mqtt_server = "demo.thingsboard.io";
const char* mqtt_token = "1m0W4Fchf2o76NIUKFpJ";

//Pinos
#define PIN_TRIG 23
#define PIN_ECHO 22

const int DHT_PIN = 17;

//LEDs
const int leddist = 27;
const int ledtemp = 26;

//Variáveis de Tempo
unsigned long lastSendTime = 0;
const long interval = 2000; 

//Define SP
int SPd = 0;
int SPt = 0;

//Distancia e Temperatura
float distancia;
float temperatura;

DHTesp dhtSensor;

WiFiClient espClient;
PubSubClient client(espClient);

void setup() {
  Serial.begin(115200);
  setup_wifi();
  client.setServer(mqtt_server, 1883);
  client.setCallback(callback);

  dhtSensor.setup(DHT_PIN, DHTesp::DHT22);
  pinMode(PIN_TRIG, OUTPUT);
  pinMode(PIN_ECHO, INPUT);

  pinMode(leddist, OUTPUT);
  pinMode(ledtemp, OUTPUT);

}

void setup_wifi() {
  delay(10);
  Serial.println();
  Serial.print("Conectando a ");
  Serial.println(ssid);

  WiFi.begin(ssid, password);

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

  Serial.println("");
  Serial.println("WiFi conectado");
  Serial.println("Endereço IP: ");
  Serial.println(WiFi.localIP());
}

void callback(char* topic, byte* payload, unsigned int length) {
  //Converte o payload para uma string
  String message;
  for (unsigned int i = 0; i < length; i++) {
    message += (char)payload[i];
  }
  Serial.print("Mensagem recebida [");
  Serial.print(topic);
  Serial.print("]: ");
  Serial.println(message);

  //Mensagem JSON
  StaticJsonDocument<200> doc;
  DeserializationError error = deserializeJson(doc, message);
  
  if (error) {
    Serial.print("Erro ao parsear JSON: ");
    Serial.println(error.c_str());
    return;
  }
  
  //Extrai os campos method e params
  const char* method = doc["method"];
  int params = doc["params"];

  Serial.print("Método: ");
  Serial.println(method);
  Serial.print("Parâmetros: ");
  Serial.println(params);

  //Controle dos LEDs
  if (String(method) == "setdist") {
    SPd = params;
  } else if (String(method) == "settemp") {
    SPt = params;
  }

}

void reconnect() {
  while (!client.connected()) {
    Serial.print("Tentando conectar ao MQTT...");
    if (client.connect("ESP32Client", mqtt_token, NULL)) {
      Serial.println("Conectado");
      client.subscribe("v1/devices/me/rpc/request/+");
    } else {
      Serial.print("falhou, rc=");
      Serial.print(client.state());
      Serial.println(" tente novamente em 5 segundos");
      delay(5000);
    }
  }
}

void sendData(float v1, float v2) {

  StaticJsonDocument<200> doc;
  doc["Valor1"] = v1;
  doc["Valor2"] = v2;

  char buffer[256];
  size_t n = serializeJson(doc, buffer);
  client.publish("v1/devices/me/telemetry", buffer, n);

}

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


  unsigned long now = millis();
  if (now - lastSendTime > interval) {
    // Inicia uma nova medição:
    digitalWrite(PIN_TRIG, HIGH);
    delayMicroseconds(10);
    digitalWrite(PIN_TRIG, LOW);
    int duration = pulseIn(PIN_ECHO, HIGH);
    distancia = (float)duration/58;
    Serial.print("Distância em CM: ");
    Serial.println(distancia);

    TempAndHumidity  data = dhtSensor.getTempAndHumidity();
    temperatura = data.temperature;
    Serial.print("Temperatura: ");
    Serial.println(temperatura);

    sendData(distancia,temperatura);

    if (SPd > distancia) {
      digitalWrite(leddist, LOW);
    } else if (SPd <= distancia) {
      digitalWrite(leddist, HIGH);
    }
    if (SPt > temperatura) {
      digitalWrite(ledtemp, LOW);
    } else if (SPt <= temperatura) {
      digitalWrite(ledtemp, HIGH);
    } 

    lastSendTime = now;
  }

}