//Código Lecturas DHT y control Servo usando Mosquitto y Node-Red

#include <WiFi.h>
#include <PubSubClient.h>
#include <ESP32Servo.h> 
#include "DHTesp.h"

//Declaración Objetos para monitoreo y control
const int DHT_PIN = 15;
DHTesp dhtSensor;
Servo myservo;       

#define pir 19


//Variables de autenticación
const char* ssid = "Wokwi-GUEST";
const char* password = "";
const char* mqtt_server = "test.mosquitto.org"; // MQTT broker
//const char* mqtt_server = "broker.emqx.io"; // MQTT broker


WiFiClient espClient;
PubSubClient client(espClient);
long lastMsg = 0;
char msg[50];
int value = 0;
bool motionDetected = false;

//Declaración de Funciones Adicionales ===================

// Indicates when motion is detected ------------------  
void IRAM_ATTR detectsMovement() 
{ 
    Serial.println("Motion Detected");
    motionDetected = true;
}    
//========================================================

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

//Callback subscriber
void callback(char* topic, byte* payload, unsigned int length) 
{
   String string;
  Serial.print("Message arrived [");
  Serial.print(topic);
  Serial.print("] ");
  for (int i = 0; i < length; i++) {
     string+=((char)payload[i]);  
  }
  Serial.print(string);

  //Servo
  if (topic == "/Motor/Servo/")  /// esp32 subscribe topic   
  {
    Serial.print(" ");
    int status = string.toInt();   
    int pos = map(status, 1, 100, 0, 180);
    Serial.println("Dato Actual: "+String(status)+" | Dato convertido: "+String(pos));
    myservo.write(pos);
    delay(15); 
  }  
  else
  //GPIOs
  //String receivedTopic = String(topic);
  //if (receivedTopic.indexOf("esp/digital/") > 0) 
  {
    String receivedTopic = String(topic);
    int stringLen = receivedTopic.length();
    int lastSlash = receivedTopic.lastIndexOf("/");
    // esp/digital/GPIO
    String gpio = receivedTopic.substring(lastSlash+1, stringLen);
    Serial.print("DIGITAL GPIO: ");
    Serial.println(gpio);
    Serial.print("STATE: ");
    Serial.println(string);
    // Check if it is DIGITAL
    if (receivedTopic.indexOf("digital") > 0) 
    {
      //Set the specified GPIO as output
      pinMode(gpio.toInt(), OUTPUT);
      //Control the GPIO
      if (string == "true")
      {
        digitalWrite(gpio.toInt(), HIGH);
      }
      else
      {
        digitalWrite(gpio.toInt(), LOW);
      }
    }
  
  }
}

void reconnect() {
  while (!client.connected()) {
    
    Serial.print("Attempting MQTT connection...");
    
    if (client.connect("ESPClient")) 
    {
      Serial.println("connected");
      client.subscribe("Motor/Servo");
      client.subscribe("esp/digital/#");
    } 
    else 
    {
      Serial.print("failed, rc=");
      Serial.print(client.state());
      Serial.println(" try again in 5 seconds"); 
      delay(5000);
    }
  }
}

// Funciones de Programa - Inicialización y Ejecución

void setup() 
{
  Serial.begin(115200);
  myservo.attach(5);
  dhtSensor.setup(DHT_PIN, DHTesp::DHT22);
  setup_wifi();
  client.setServer(mqtt_server, 1883);
  client.setCallback(callback);
  pinMode(pir,INPUT);
  attachInterrupt(digitalPinToInterrupt(pir), detectsMovement, RISING);
}

void loop() 
{
  if (!client.connected()) 
  {
    reconnect();
  }
  client.loop(); 
 
  String motion = "true";
  
  //PIR
  if(motionDetected == true)
    {
      // Publish an MQTT message on topic esp/motion
      client.publish("esp/motion/notification", String("true").c_str());    
      motionDetected = false;
    }
  else
    {
      client.publish("esp/motion/notification", String("false").c_str());  
    }  

  //DHT
  TempAndHumidity  data = dhtSensor.getTempAndHumidity();
  String temp = String(data.temperature, 2);
  //client.publish("/Readings/temp", temp.c_str());
  client.publish("/read/temperature/", temp.c_str());
  Serial.println("Temp: " + temp + "°C");
  String hum = String(data.humidity, 1);
  //client.publish("/Readings/hum", hum.c_str());
  client.publish("/read/humidity/", hum.c_str());
  Serial.println("Humidity: " + hum + "%");
  

  Serial.println("---");
  
  delay(2000); // Espera estabilizar lectura sensor (DHT22 -> ~0.5Hz sample rate)
}