#include <WiFi.h> //conectar né
#include <WiFiClient.h>
#include <PubSubClient.h> //publicar e inscrever
#include <LiquidCrystal_I2C.h> //biblioteca lcd

LiquidCrystal_I2C lcd(0x27,16,2);

int ledPin = 2; 		// GPIO do LED
int ledState = LOW; 	//ESTADO DO LED
int trigP = 13; //pinos trig e echo
int echoP = 12;
long previousMillis = 0;
int interval = 1000;	//Intervalo para o Blink

const char* ssid = "Wokwi-GUEST";
const char* password = "";

const char* hostname = "broker.hivemq.com";

WiFiClient espClient;
PubSubClient client(espClient);
const char* espClientName = "1darlaele1"; //ID
int PORTNUM = 1883;

void setup_wifi()
{
  WiFi.begin(ssid, password);
  while (WiFi.status() != WL_CONNECTED )
  {
    delay(1000);
    Serial.print(".");
  }
  Serial.println();
  Serial.print("Conectado a rede SSID: ");
  Serial.println(ssid);
  Serial.print("IP: ");
  Serial.println(WiFi.localIP());
}

void connectMQTT()
{
  while (!client.connected() )
  {
    Serial.println("Conectando ao MQTT ...");
    if (client.connect(espClientName) ) //, mqttUser, mqttPassword) )
    {
      Serial.println("Conectado");
      //MQTTSubscribe();
    }
    else
    {
      Serial.print("Falha com Estado: ");
      Serial.print(client.state() );
      delay(2000);
    }
  }
}

void callback(String topic, byte* payload, unsigned int length)
{ 
  lcd.setCursor(1,1);
  String messageTemp;
  Serial.print("Mensagem recebida no TOPICO:");
  Serial.print(topic);
  Serial.print("O Tamanho da Mensagem: ");
  Serial.println(length);

  Serial.print("Dados Recebidos no Broker: ");
  for (int i = 0; i < length; i++)
  {
    messageTemp += (char)payload[i];
  }
  // if (topic == "teste/aula87348734/1")
  // {
  //   lcd.clear();
  //   lcd.setCursor(0,0);
  //   lcd.print(messageTemp.c_str());
  // }
}

// void MQTTSubscribe()
// {
//   client.subscribe("teste/aula87348734/1"); //não está inscrito no tópico
// }

void setup_MQTT()
{
  client.setServer(hostname, PORTNUM);
  client.setCallback(callback);
}

void setup()
{
  Serial.begin(9600);
  delay(5000);
  lcd.init();
  lcd.backlight();
  lcd.setCursor(1,0);
  lcd.print("DAR");


  setup_wifi();
  setup_MQTT();
  pinMode(ledPin, OUTPUT);
  pinMode(trigP,OUTPUT);
  pinMode(echoP,INPUT);
  digitalWrite(ledPin, LOW);

}

float readDistanceCM() { //Calcular a distância, copiado do código anterior
  digitalWrite(trigP, LOW);          // Garante que o pino TRIG esteja LOW
  delayMicroseconds(2);                 // Espera 2 microssegundos
  digitalWrite(trigP, HIGH);         // Envia um pulso HIGH no pino TRIG para iniciar a medição
  delayMicroseconds(10);                // Aguarda 10 microssegundos
  digitalWrite(trigP, LOW);          // Termina o pulso de disparo no pino TRIG
  int duration = pulseIn(echoP, HIGH); // Mede o tempo que o pino ECHO fica HIGH
  return duration * 0.034 / 2;          // Calcula a distância em cm com base na duração do pulso
}

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

  
  long currentMillis = millis();

  float distance = readDistanceCM(); //distância

  if ( currentMillis - previousMillis >= interval)
  {
    previousMillis = currentMillis; // save the last time you blinked the LED
      //int pot = analogRead(A0);
      String disString = String(distance); //converte para string
     client.publish("teste/aula87348734/1", disString.c_str());
  }


}