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

char GLED = 18;
char RLED = 23;

long RLED_previous_millis = 0;
char RLED_state =LOW;
int RLED_interval =500;

const char* ssid = "Wokwi-GUEST";
const char* password = "";

const char* hostname = "broker.hivemq.com";

WiFiClient espClient;
PubSubClient client(espClient);
const char* espClientName = "esp32Client_JonasNG"; // yourStudentID must be unique
int PORTNUM = 1883;

void setup_wifi()
{
  WiFi.begin(ssid, password);
  while(WiFi.status() != WL_CONNECTED )
  {
    delay(1000);
    Serial.print(".");
  }
  Serial.println();
  Serial.print("Connected to ");
  Serial.println(ssid);
  Serial.print("Given IP by the router to ESP32 is ");
  Serial.println(WiFi.localIP());
}

void connectMQTT()
{
  while(!client.connected() )
  {
    Serial.println("Connecting to MQTT ...");
    if (client.connect(espClientName) ) //, mqttUser, mqttPassword) )
    {
      Serial.println("Connected");
      MQTTSubscribe();
    }
    else
    {
      Serial.print("Failed with state ");
      Serial.print(client.state() );
      delay(2000);
    }
  }
}

void callback(String topic, byte* payload, unsigned int length)
{
  String messageTemp;
  Serial.print("Message received in topic: ");
  Serial.print(topic);
  Serial.print(" length is: ");
  Serial.println(length);

  Serial.print("Data received from broker: ");
  for (int i = 0; i<length; i++)
  {
    Serial.print( (char)payload[i] );
    messageTemp += (char)payload[i];
  }

 /// Handle your topics and payload here
 // Example

  if (topic == "JonasNG/lab6/RLED")  
  {
    Serial.print("Changing GLED to ");
    if (messageTemp == "off")
    {
      digitalWrite(GLED, HIGH);
      Serial.println("off");
    }
    else if (messageTemp == "on")
    {
      digitalWrite(GLED, LOW);
      Serial.println("on");
    }
  }
}

void MQTTSubscribe() 
{
  // Subsccribe to your topics here
  client.subscribe("JonasNG/lab6/RLED");  // example

}

void setup_MQTT() 
{
  client.setServer(hostname, PORTNUM);
  client.setCallback(callback); 

}

void setup() 
{
  Serial.begin(9600);
  delay(5000);

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

  setup_wifi();
  setup_MQTT();
}

void loop() 
{
  if ( !client.connected() )
  {
    connectMQTT();
  }
  client.loop();

  long current_millis = millis();

  if (current_millis - RLED_previous_millis >= RLED_interval)
  {
    RLED_previous_millis = current_millis;
    if(RLED_state == LOW)
    {
      RLED_state =HIGH;
      digitalWrite(RLED, RLED_state); //OFF red led
      //send 'OFF"
      client.publish("JonasNG/lab6/RLED","off");
      //topic name is "JonasNG/lab6/RLED"
      //message if "OFF"
    }
    else
    {
      RLED_state =LOW;
      digitalWrite(RLED, RLED_state);//ON red led
      client.publish("JonasNG/lab6/RLED","on");
    }
  }
}