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

#define WIFI_SSID "Wokwi-GUEST"
#define WIFI_PASSWORD ""
// Defining the WiFi channel speeds up the connection:
#define WIFI_CHANNEL 6

// constantes del MQTT
// direccion broker, puerto, y nombre cliente
//const char *MQTT_BROKER_ADRESS = "test.mosquitto.org";
const char *MQTT_BROKER_ADRESS = "mqtt.eclipseprojects.io";
const uint16_t MQTT_PORT = 1883;
const char *MQTT_CLIENT_NAME = "MCR_Wokwi_ESP32_sub_led";

// instanciar objetos
WiFiClient espClient;
PubSubClient mqttClient(espClient);

String payload;
String content = "";
String readTopic = "";
char readChar;

#define RLED 16
#define GLED 17
#define BLED 5

void ConnectWiFi()
{
  WiFi.begin(WIFI_SSID, WIFI_PASSWORD, WIFI_CHANNEL);
  Serial.print("Connecting to WiFi ");
  Serial.print(WIFI_SSID);
  // Wait for connection
  while (WiFi.status() != WL_CONNECTED)
  {
    delay(100);
    Serial.print(".");
  }
  Serial.println(" Connected!");

  Serial.print("IP address: ");
  Serial.println(WiFi.localIP());
}

void InitMqtt()
{
  mqttClient.setServer(MQTT_BROKER_ADRESS, MQTT_PORT);
  SuscribeMqtt();
  mqttClient.setCallback(OnMqttReceived);
}

void ConnectMqtt()
{
  while (!mqttClient.connected())
  {
    Serial.print("Starting MQTT connection...");
    if (mqttClient.connect(MQTT_CLIENT_NAME))
    {
      SuscribeMqtt();
    }
    else
    {
      Serial.print("Failed MQTT connection, rc=");
      Serial.print(mqttClient.state());
      Serial.println(" try again in 5 seconds");

      delay(5000);
    }
  }
}

void HandleMqtt()
{
  if (!mqttClient.connected())
  {
    ConnectMqtt();
  }
  mqttClient.loop();
}

void SuscribeMqtt()
{
  mqttClient.subscribe("MCR/buttonStatus/G");
  mqttClient.subscribe("MCR/buttonStatus/R");
  mqttClient.subscribe("MCR/buttonStatus/B");
}

void gestionLed(bool accion, int led) {
  digitalWrite(led, accion);
}

void OnMqttReceived(char *topic, byte *payload, unsigned int length)
{
  Serial.print("Received on ");
  Serial.print(topic);
  Serial.print(": ");

  readTopic = "";
  readChar = ' ';
  int j = 0;

  while (readChar != '\0') {
    readChar = (char)topic[j];
    readTopic.concat(readChar);
    j++;
  }
  readTopic.remove(readTopic.length() - 1); // Elimino el ultimo caracter publicado

  content = "";
  for (size_t i = 0; i < length; i++)
  {
    content.concat((char)payload[i]);
  }

  int color;

  if (readTopic == "MCR/buttonStatus/R") {
    color = RLED;
  } else if (readTopic == "MCR/buttonStatus/G" ) {
    color = GLED;
  } else if (readTopic == "MCR/buttonStatus/B" ) {
    color = BLED;
  }


  if (content == "pulsado" ) {
    digitalWrite(color, HIGH);
  }

  if (content == "suelto" ) {
    digitalWrite(color, LOW);
  }


  Serial.print(content);
  Serial.println();

}

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

  pinMode(RLED, OUTPUT);
  pinMode(GLED, OUTPUT);
  pinMode(BLED, OUTPUT);
  digitalWrite(RLED, LOW);
  digitalWrite(GLED, LOW);
  digitalWrite(BLED, LOW);



  ConnectWiFi();

  InitMqtt();
}

void loop()
{
  HandleMqtt();

  delay(10);
}