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

#include "Barometer.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;


unsigned long ts, perioada = 10000;

// WiFi settings
//const char *ssid = "Acasuca_2.4G";             
//const char *password = "kNY2ph3mmrnT6zk4";   

//const char *ssid = "Acasuca";             
//const char *password = "pavlov61ap7";   


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


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

const char *mqtt_topic = "esp32/esp8266";       // MQTT topic pentru primit comenzi
const char *mqtt_topic_led = "esp32/esp8266/led";    // MQTT topic pentru trimis "stare led"
//const char *mqtt_topic_t = "esp32/esp8266/temp";     // MQTT topic pentru trimis temperatura
//const char *mqtt_topic_p = "esp32/esp8266/pres";     // MQTT topic pentru trimis presiunea in Pa
//const char *mqtt_topic_a = "esp32/esp8266/atm";     // MQTT topic pentru trimis presiunea in bar
const char *mqtt_topic_r1 = "esp32/esp8266/rel1";     // MQTT topic pentru trimis confirmare "stare releu1"
const char *mqtt_topic_r2 = "esp32/esp8266/rel2";     // MQTT topic pentru trimis confirmare "stare releu2"


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)

WiFiClient espClient;
PubSubClient mqtt_client(espClient);

void connectToWiFi();

void connectToMQTTBroker();

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


void setup() {

    Serial.begin(115200);
    Serial.println("Start tft.begin");

    pinMode(LED, OUTPUT);
    digitalWrite(LED, !LOW);

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

    digitalWrite(REL1, LOW);
    digitalWrite(REL2, LOW);

    connectToWiFi();

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

    ts = millis();

  }//sfarsitul setup


void connectToWiFi() {

    Serial.print("Connectare 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.println(ssid[s]);

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

   break;

  } // end if
 } // end for

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


} // end connectToWiFi



void connectToMQTTBroker() {
    while (!mqtt_client.connected()) {
        String client_id = "esp8266-client MAC: " + String(WiFi.macAddress());
        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.print(mqtt_broker); Serial.print(":"); Serial.println(mqtt_port);

  // Poate fi doar o singura "incoming_subscribe", când comanda se da pe acel topic
  // sau mai multe, când comanda se da pe fiecare topic În parte

            mqtt_client.subscribe(mqtt_topic);
 
            mqtt_client.subscribe(mqtt_topic_t);
            mqtt_client.subscribe(mqtt_topic_p);
            mqtt_client.subscribe(mqtt_topic_a);
            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 esp32");

        } else {
            Serial.print("Am esuat sa ma conectez la MQTT broker, rc=");
            Serial.print(mqtt_client.state());
            Serial.println(" incearca inapoi in 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 (message == "ledon" && !led_State) {
        digitalWrite(LED, !HIGH);  // Porneste LEDul
        led_State = true;
  mqtt_client.publish(mqtt_topic_led, String("ledon").c_str(), false);
        Serial.println("LEDul este pornit");
    }

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


    // R1 Controlul releului bazat pe messageul primit
    if (message == "r1on" && !rel1_State) {
        digitalWrite(REL1, HIGH);  // Porneste LEDul
        rel1_State = true;
  mqtt_client.publish(mqtt_topic_r1, String("r1on").c_str(), false);
        Serial.println("Rel1 este pornit");
    }

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


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

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

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


void trimiteStareTempPres(){

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

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

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

} // end trimite stare


void loop() {

  if( ((millis() - ts) >= perioada) || (millis() < ts) ) {
  ts = millis();

  trimiteStareTempPres();

  }// end if millis

    if (!mqtt_client.connected()) {
        connectToMQTTBroker();
    }
    mqtt_client.loop();

}// end loop


// Secventa de break;

/*

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