#include <WiFi.h> 
#include <PubSubClient.h>

#include <NewPing.h> // Biblioteca para o sensor ultrassônico



// Definições do sensor ultrassônico
#define TRIGGER_PIN 37
#define ECHO_PIN 26
#define MAX_DISTANCE 200
NewPing sonar(TRIGGER_PIN, ECHO_PIN, MAX_DISTANCE);

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

// Configurações do servidor MQTT
const char* mqtt_server = "test.mosquitto.org";
WiFiClient espClient;
PubSubClient client(espClient);

// Variáveis globais
unsigned long lastMsg = 0;


void setup_wifi() {
 delay(10);
 Serial.println();
 Serial.print("Connecting to ");
 Serial.println(ssid);

 WiFi.mode(WIFI_STA);
 WiFi.begin(ssid, password);

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

 randomSeed(micros());

 Serial.println("");
 Serial.println("WiFi connected");
 Serial.println("IP address: ");
 Serial.println(WiFi.localIP());
}

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

void reconnect() {
 while (!client.connected()) {
   Serial.print("Attempting MQTT connection...");
   String clientId = "ESP32Client-";
   clientId += String(random(0xffff), HEX);
   if (client.connect(clientId.c_str())) {
     Serial.println("Connected");
     client.publish("/ThinkIOT/Publish", "Welcome");
     client.subscribe("/ThinkIOT/Subscribe");
   } else {
     Serial.print("failed, rc=");
     Serial.print(client.state());
     Serial.println(" try again in 5 seconds");
     delay(5000);
   }
 }
}

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

}

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

 unsigned long now = millis();
 if (now - lastMsg > 2000) { 
   lastMsg = now;


   // Leitura do sensor ultrassônico
   unsigned int distance = sonar.ping_cm();
   String distanceStr = String(distance);
   client.publish("/ThinkIOT/distance1", distanceStr.c_str());

   Serial.print("Distance: ");
   Serial.println(distanceStr);
 }
}