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


// Pentru nodMcu32s 
//BMP180
//SDA = 21
//SCL = 22
//   3.3V     
//   5v       
//   Gnd      



#ifdef LED
#undef LED
#endif

#define LED 2 // GPIO 23 (D4) pentru LED
bool led_State = false;

#define REL1 16 // GPIO 16 
bool rel1_State = false;

#define REL2 17 // GPIO 17
bool rel2_State = false;

float temperatura, presiune, atm, mmHg ;

const long perioada = 10000, t_monostabil = 3000;  // intervale fixe in milisecunde
						   //10s perioada de transmitere automata a datelor

//long rssi = 0;
unsigned long long ts, ts1;

// WiFi settings

const char *ssid[] = {"masserv-1", "DIGI-B378", "Acasuca", "Acasuca_2.4G"};
const char *password[]={"protocoale", "HYEkzKq6", "pavlov61ap7", "kNY2ph3mmrnT6zk4"};


// setari MQTT 
const char *mqtt_broker = "masserv.utcluj.ro";  // maserv broker endpoint

const char *mqtt_topic = "mas/esp32";       // MQTT topic pentru transmitere feedback comenzi led, r1, r2 si mesaje de stare
const char *mqtt_topic_led = "mas/esp32/led";    // MQTT topic pentru primire comenzi "ledon/ledoff"
const char *mqtt_topic_r1 = "mas/esp32/rel1";     // MQTT topic pentru primire comenzi releu1 "r1on/r1off" 
const char *mqtt_topic_r2 = "mas/esp32/rel2";     // MQTT topic pentru primire comenzi releu2 "r2on/r2off"

const char *mqtt_topic_t = "mas/esp32/temp";     // MQTT topic pentru trimitere temperatura
const char *mqtt_topic_p = "mas/esp32/pres";     // MQTT topic pentru trimitere presiune in Pa
const char *mqtt_topic_a = "mas/esp32/atm";     // MQTT topic pentru trimitere presiune in bar
const char *mqtt_topic_mmHg = "mas/esp32/mmHg";     // MQTT topic pentru trimitere presiune in mmHg


const char *mqtt_username = "iot_client";  // MQTT username pentru autentificare
const char *mqtt_password = "ASA123";  // MQTT parola pentru autentficare
const int mqtt_port = 1883;  // MQTT port (TCP)

// Initializare obiecte

BMP280 bmp280;
WiFiClient espClient;
PubSubClient mqtt_client(espClient);


void connectToWiFi();
void connectToMQTTBroker();
void mqttCallback(char *topic, byte *payload, unsigned int length);


void setup() {

    pinMode(LED, OUTPUT);
    digitalWrite(LED, LOW);
    led_State = false;

    pinMode(REL1, OUTPUT);
    pinMode(REL2, OUTPUT);

    digitalWrite(REL1, LOW);
    digitalWrite(REL2, LOW);
    rel1_State = false;
    rel2_State = false;

    Serial.begin(115200);

    connectToWiFi();

    mqtt_client.setServer(mqtt_broker, mqtt_port);
    mqtt_client.setCallback(mqttCallback);
    connectToMQTTBroker();

    Serial.println("Initializare BMP280");

   bmp280.init();
/*
  Wire.begin();

  if (!bmp280.init()) {
    Serial.println("BMP280 nu este conectat!");
  }
*/

   ts = millis();
   ts1 = millis();

  }//sfarsitul setup


void connectToWiFi() {

    //Serial.println("\nConnectare la WiFi:");

   for (byte s=0; s<sizeof(ssid); s++) {

    //Serial.println(""); //Serial.print(s+1); //Serial.print(". ");
    //Serial.print(ssid[s]);

    WiFi.begin(ssid[s], password[s]);

	ts = millis();

    while((WiFi.status() != WL_CONNECTED) && ((millis() - ts) < 10000) ) {
        delay(500);
        //Serial.print(".");
    }

  if(WiFi.status() == WL_CONNECTED ) {

    Serial.print("\nConectat la reteaua WiFi: ");
    Serial.print(ssid[s]);
    Serial.printf(", RSSI: %ld dBm, ", WiFi.RSSI());
    Serial.printf("IP: %s\n\n", WiFi.localIP().toString());


   digitalWrite(LED, HIGH);  // Porneste LEDul
   led_State = true;

   break;

  } // end if
 } // end for

    while(WiFi.status() != WL_CONNECTED) {
        delay(500);
    //    //Serial.print(".");
    } // Ramane in aceasta bucla daca nu se conecteaza la WiFi !

} // end connectToWiFi



void connectToMQTTBroker() {
    while (!mqtt_client.connected()) {

        String client_id = "vio-virgil-client MAC: " + String(WiFi.macAddress()) + ", user: " + String(mqtt_username);

        //Serial.printf("Conectare la MQTT Broker ca %s \r\n", client_id.c_str() );

        if (mqtt_client.connect(client_id.c_str(), mqtt_username, mqtt_password)) {

            Serial.print("Conectat la MQTT Broker: ");
            Serial.println(mqtt_broker); //Serial.print(":"); //Serial.println(mqtt_port);

  // Poate fi doar o singura "incoming_subscribe", cand comanda se da pe acel topic
  // sau mai multe, cānd comanda se da pe fiecare topic in parte

            mqtt_client.subscribe(mqtt_topic);
            mqtt_client.subscribe(mqtt_topic_led);
            mqtt_client.subscribe(mqtt_topic_r1);
            mqtt_client.subscribe(mqtt_topic_r2);

            // Publica messageul la conectarea reusita
            mqtt_client.publish(mqtt_topic, "M-am conectat la Benic ca IotClient");


        } else {
            //Serial.print("Am esuat sa ma conectez la MQTT broker, rc=");
            //Serial.print(mqtt_client.state());
            //Serial.println(" incearca din nou dupa 5 secunde");
            delay(5000);
        }
    }

} // end connectToMQTTBroker



void mqttCallback(char *topic, byte *payload, unsigned int length) {
//    //Serial.print("Mesaj primit pe topic: ");
//    //Serial.println(topic);
//    //Serial.println("Mesaj:");

    String message;
    for (int i = 0; i < length; i++) {
        message += (char) payload[i];  // Transforma *byte in string
    }

//    //Serial.print("Mesaj: ");
//    //Serial.println(message);


    // Controlul LED ului bazat pe mmessageul primit
    if (String(topic) == mqtt_topic_led && message == "ledon" && !led_State) {
        digitalWrite(LED, HIGH);  // Porneste LEDul
        led_State = true;

  mqtt_client.publish(mqtt_topic, String("ledon").c_str(), false);
//        //Serial.println("LEDul este pornit");

    }

    if (String(topic) == mqtt_topic_led && message == "ledoff" && led_State) {
        digitalWrite(LED, LOW); // Opreste LEDul
        led_State = false;
  mqtt_client.publish(mqtt_topic, String("ledoff").c_str(), false);
//        //Serial.println("LEDul este oprit");
    }
//sfarsitul topic LED


    // R1 Controlul releului 1 bazat pe messageul primit
    if (String(topic) == mqtt_topic_r1 && message == "r1on" && !rel1_State) {
        digitalWrite(REL1, HIGH);  // Porneste LEDul
        rel1_State = true;
  mqtt_client.publish(mqtt_topic, String("r1on").c_str(), false);

          ts1 = millis();

//        //Serial.println("Rel1 este pornit");
    }

    if (String(topic) == mqtt_topic_r1 && message == "r1off" && rel1_State) {
        digitalWrite(REL1, LOW); // Opreste LEDul
        rel1_State = false;
  mqtt_client.publish(mqtt_topic, String("r1off").c_str(), false);
//        //Serial.println("Rel1 este oprit");
    }
//sfarsitul topic r1


   // R2 Controlul releului bazat pe messageul primit
    if (String(topic) == mqtt_topic_r2 && message == "r2on" && !rel2_State) {
        digitalWrite(REL2, HIGH);  // Porneste LEDul
        rel2_State = true;
  mqtt_client.publish(mqtt_topic, String("r2on").c_str(), false);
//        //Serial.println("Rel2 Este pornit");
    }

    if (String(topic) == mqtt_topic_r2 && message == "r2off" && rel2_State ) {
        digitalWrite(REL2, LOW); // Opreste LEDul
        rel2_State = false;
  mqtt_client.publish(mqtt_topic, String("r2off").c_str(), false);
//        //Serial.println("Rel2 Este oprit");
    }
//sfarsitul topic r2

//    //Serial.println();
//    //Serial.println("-----------------------\n");

}//end MQTTCallback


void citireTempPres(){

 //Citirea temperaturii, bmp280getTemperature trebuie invocat prima.
 // Temperatura este folosita si pentru corectia presiunii !

   temperatura = bmp280.getTemperature();
   presiune = bmp280.getPressure();
   atm = presiune / 101325;
   mmHg = atm * 760;
}//end citireTempPres


void trimiteStareRelee(){

if (rel1_State){
  mqtt_client.publish(mqtt_topic, String("r1on").c_str(), false);
} else {
  mqtt_client.publish(mqtt_topic, String("r1off").c_str(), false);
}

if (rel2_State){
  mqtt_client.publish(mqtt_topic, String("r2on").c_str(), false);
} else {
  mqtt_client.publish(mqtt_topic, String("r2off").c_str(), false);
}

if (led_State){
  mqtt_client.publish(mqtt_topic, String("ledon").c_str(), false);
} else {
  mqtt_client.publish(mqtt_topic, String("ledoff").c_str(), false);
}

// Listare temperatura si presiune
  mqtt_client.publish(mqtt_topic_t, String(temperatura).c_str(), false);
  mqtt_client.publish(mqtt_topic_p, String(presiune/100, 2).c_str(), false);
  mqtt_client.publish(mqtt_topic_a, String(atm,5).c_str(), false);
  mqtt_client.publish(mqtt_topic_mmHg, String(mmHg,2).c_str(), false);


//  rssi = WiFi.RSSI();
  char rssibuff[30];
  sprintf(rssibuff, "%s RSSI: %d dBm", WiFi.SSID(), WiFi.RSSI());
  //Serial.println(rssibuff);

  mqtt_client.publish(mqtt_topic, rssibuff, false);
 

} // end trimite stare


void loop() {

  if( ((millis() - ts) >= perioada) || (millis() < ts) ) {
  ts = millis();
  citireTempPres();
  trimiteStareRelee();
  }// end if millis

//Reconectare la server MQTT
    if (!mqtt_client.connected()) {
        connectToMQTTBroker();
    }
    mqtt_client.loop();

  //Temporizarea Rel1 la t_monostabil = 1 secunda
      if (rel1_State == true){

       if(millis() - ts1 >= t_monostabil){
        digitalWrite(REL1, LOW);  // Opreste releul
        rel1_State = false;
        mqtt_client.publish(mqtt_topic, String("r1off").c_str(), false);

      ts1 = millis();
        }

     }//end if rel1_State


}// end loop


// Secventa de break;

/*

for (i = 0; i < 10; i++) {
  if (i == 4) {
    break;
  }
  printf("%d\n", i);
}
*/