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

// Configurações de Wi-Fi
const char* ssid = "Wokwi-GUEST";
const char* password = "";
const char* mqtt_server = "test.mosquitto.org"; // MQTT broker

const char* mqtt_topic_start = "linhaProducao/produtoInicializado";  // Tópico para produto inicializado
const char* mqtt_topic_end = "linhaProducao/produtoFinalizado";      // Tópico para produto finalizado

WiFiClient espClient;
PubSubClient client(espClient);

#define TRIGGER_PIN_1 12  // Pino trigger do sensor 1
#define ECHO_PIN_1 13     // Pino echo do sensor 1
#define TRIGGER_PIN_2 14  // Pino trigger do sensor 2
#define ECHO_PIN_2 27     // Pino echo do sensor 2
#define MAX_DISTANCE 200  // Distância máxima em cm para considerar um produto

NewPing sensor1(TRIGGER_PIN_1, ECHO_PIN_1, MAX_DISTANCE);
NewPing sensor2(TRIGGER_PIN_2, ECHO_PIN_2, MAX_DISTANCE);

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

  // Conectar ao Wi-Fi
  setup_wifi();

  // Configurar o cliente MQTT
  client.setServer(mqtt_server, 1883);
}

void loop() {
  // Reconecta ao MQTT se necessário
  if (!client.connected()) {
    reconnect();
  }
  client.loop();

  // Leitura dos sensores
  unsigned int dist1 = sensor1.ping_cm();
  unsigned int dist2 = sensor2.ping_cm();

  // Verifica se o produto foi inicializado
  if (dist1 > 0 && dist1 <= 200) {
    Serial.println("Produto inicializado.");
    String timestamp = String(millis());
    client.publish(mqtt_topic_start, timestamp.c_str());
  }

  // Verifica se o produto foi finalizado
  if (dist2 > 0 && dist2 <= 200) {
    Serial.println("Produto finalizado.");
    String timestamp = String(millis());
    client.publish(mqtt_topic_end, timestamp.c_str());
  }

  delay(100);  // Aguarda 100ms antes de nova leitura
}

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 reconnect() {
  // Loop até que o cliente esteja conectado
  while (!client.connected()) {
    Serial.print("Tentando conexão MQTT...");
    // Tenta se conectar
    if (client.connect("ESP32Client")) {
      Serial.println("Conectado");
    } else {
      Serial.print("Falha, rc=");
      Serial.print(client.state());
      Serial.println(" Tentando novamente em 5 segundos");
      delay(5000);
    }
  }
}