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

#define led1 2
#define led2 4
#define LED_Yellow 14
#define LED_Violet 13
#define LED_Blue 12

const int t_p = 27;
const int e_p = 26;
const float ss = 0.034; //sound speed s/m
long time_duration;
float distance_cm;
float nouveau_distance;

const int DHT_PIN = 15;  
DHTesp dht; 
const char* ssid = "Wokwi-GUEST"; ///  wifi ssid 
const char* password = "";
const char* mqtt_server = "test.mosquitto.org";// mosquitto server url

WiFiClient espClient;
PubSubClient client(espClient);
unsigned long lastMsg = 0;
float temp = 0;
float hum = 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) { 
  String message;
  Serial.print("Message arrived [");
  Serial.print(topic);
  Serial.print("] ");
  for (unsigned int i = 0; i < length; i++) { 
    Serial.print((char)payload[i]);
    message += (char)payload[i];
  }
  if(String(topic) == String("/securité/ledState2")){
    if(message == "true"){
      digitalWrite(led1, HIGH);
    }
    else{
      digitalWrite(led1, LOW);
    }
  }
  if(String(topic) == String("/securité/ledState1")){
    if(message == "true"){
      digitalWrite(led2, HIGH);
    }
    else{
      digitalWrite(led2, LOW);
    }
  }
  if(String(topic) == String("/Lampes/ledYellow")){
    if(message == "true"){
      client.publish("/Lampes/offBlue", "false");
      client.publish("/Lampes/offViolet", "false");
      client.publish("/Lampes/offIndigo", "false");
      digitalWrite(LED_Yellow, HIGH);
    }
    else{
      digitalWrite(LED_Yellow, LOW);
    }
  }
   if(String(topic) == String("/Lampes/ledBlue")){
    if(message == "true"){
      client.publish("/Lampes/offYellow", "false");
      client.publish("/Lampes/offViolet", "false");
      client.publish("/Lampes/offRed", "false");
      digitalWrite(LED_Blue, HIGH);
    }
    else{
      digitalWrite(LED_Blue, LOW);
    }
  }
   if(String(topic) == String("/Lampes/ledViolet")){
    if(message == "true"){
      client.publish("/Lampes/offBlue", "false");
      client.publish("/Lampes/offYellow", "false");
      client.publish("/Lampes/offGreen", "false");
      digitalWrite(LED_Violet, HIGH);
    }
    else{
      digitalWrite(LED_Violet, LOW);
    }
  }
     if(String(topic) == String("/Lampes/ledIndigo")){
    if(message == "true"){
      client.publish("/Lampes/offYellow", "false");
      digitalWrite(LED_Violet, HIGH);
      digitalWrite(LED_Blue, HIGH);
    }
    else{
      digitalWrite(LED_Violet, LOW);
      digitalWrite(LED_Blue, LOW);
    }
  }
     if(String(topic) == String("/Lampes/ledRed")){
    if(message == "true"){
      client.publish("/Lampes/offBlue", "false");
      digitalWrite(LED_Violet, HIGH);
      digitalWrite(LED_Yellow, HIGH);
    }
    else{
      digitalWrite(LED_Violet, LOW);
      digitalWrite(LED_Yellow, LOW);
    }
  }
     if(String(topic) == String("/Lampes/ledGreen")){
      if(message == "true"){
        client.publish("/Lampes/offViolet", "false");
        digitalWrite(LED_Yellow, HIGH);
        digitalWrite(LED_Blue, HIGH);
      }
      else{
        digitalWrite(LED_Yellow, LOW);
        digitalWrite(LED_Blue, LOW);
      }
  }
     if(String(topic) == String("/Lampes/ledWhite")){
      if(message == "true"){
        digitalWrite(LED_Violet, HIGH);
        digitalWrite(LED_Yellow, HIGH);
        digitalWrite(LED_Blue, HIGH);
      }
      else{
        digitalWrite(LED_Violet, LOW);
        digitalWrite(LED_Yellow, LOW);
        digitalWrite(LED_Blue, LOW);
      }
    }
    if(String(topic) == String("/securité/ultrason")){
      nouveau_distance = message.toFloat();
      Serial.println("d : ");
      Serial.println(message);    
    }
    Serial.println();
  }
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.subscribe("/securité/ledState1");
      client.subscribe("/securité/ledState2");
      client.subscribe("/Lampes/ledViolet");
      client.subscribe("/Lampes/ledBlue");
      client.subscribe("/Lampes/ledYellow");
      client.subscribe("/Lampes/ledIndigo");
      client.subscribe("/Lampes/ledRed");
      client.subscribe("/Lampes/ledGreen");
      client.subscribe("/Lampes/ledWhite");
      client.subscribe("/securité/ultrason");

      
    } else {
      Serial.print("failed, rc=");
      Serial.print(client.state());
      Serial.println(" try again in 5 seconds");
      delay(5000);
    }}
}
void setup() {
  pinMode(led1, OUTPUT);
  pinMode(led2, OUTPUT);
  pinMode(LED_Blue, OUTPUT);
  pinMode(LED_Yellow, OUTPUT);
  pinMode(LED_Violet, OUTPUT);
  pinMode(t_p, OUTPUT);
  pinMode(e_p, INPUT);
  Serial.begin(115200);
  setup_wifi(); 
  client.setServer(mqtt_server, 1883);
  client.setCallback(callback); 
  dht.setup(DHT_PIN, DHTesp::DHT22);
}
void loop() {
  if (!client.connected()) {
    reconnect();
  }
  client.loop();

  unsigned long now = millis();
  if (now - lastMsg > 2000) { //perintah publish data
    lastMsg = now;
    TempAndHumidity  data = dht.getTempAndHumidity();

    String temp = String(data.temperature, 2);
    client.publish("/Tempèrature /temp", temp.c_str()); // publish temp topic /ThinkIOT/temp
    String hum = String(data.humidity, 1); 
    client.publish("/Tempèrature /hum", hum.c_str());   // publish hum topic /ThinkIOT/hum

    Serial.print("Temperature: ");
    Serial.println(temp);
    Serial.print("Humidity: ");
    Serial.println(hum);
  }

  digitalWrite(t_p,LOW);
  delayMicroseconds(2);
  digitalWrite(t_p,HIGH);
  delayMicroseconds(10);
  digitalWrite(t_p,LOW);
  time_duration=pulseIn(e_p,HIGH);
  distance_cm=time_duration*ss/2;
  Serial.println("distance = ");
  Serial.println(distance_cm);
  if(distance_cm <= nouveau_distance){
    client.publish("/Urgence/PresenceAlert", "true");
    delay(2000);
  }
  else{
    client.publish("/Urgence/PresenceAlert", "false");
  }
}