#include <WiFi.h>
#include "Adafruit_MQTT.h"
#include "Adafruit_MQTT_Client.h"

#define FLEX_SENSOR1 36
#define FLEX_SENSOR2 39
#define FLEX_SENSOR3 34
#define FLEX_SENSOR4 35
#define FLEX_SENSOR5 32


#define NO_FINGERS 5
#define WLAN_SSID "Wokwi-GUEST"
#define WLAN_PASS ""
//char ssid[] = "Wokwi-GUEST";                // SSID of your ESP Server
//char pass[] = "";                   // password of your ESP SEVER
 //|--------------AIO Connection configuration------------------|
//NOTE: Change the username to your username, the key to
//      your AIO Key, and the feed to your feed.     
#define AIO_SERVER            "io.adafruit.com"
#define AIO_SERVERPORT        1883 
#define AIO_USERNAME          "vickys"
#define AIO_FEED_FINGER1      "/feeds/glove.finger1"
#define AIO_FEED_FINGER2      "/feeds/glove.finger2"
#define AIO_FEED_FINGER3      "/feeds/glove.finger3"
#define AIO_FEED_FINGER4      "/feeds/glove.finger4"
#define AIO_FEED_FINGER5      "/feeds/glove.finger5"
#define AIO_FEED_FINGER0      "/feeds/finger0"

#define AIO_KEY               "aio_Orkn81b3cPKd7TJZWoEStptu884a"

WiFiClient client;
Adafruit_MQTT_Client mqtt(&client, AIO_SERVER, AIO_SERVERPORT, AIO_USERNAME, AIO_KEY); //mqtt client
Adafruit_MQTT_Publish sendData[NO_FINGERS] = {
  Adafruit_MQTT_Publish(&mqtt, AIO_USERNAME AIO_FEED_FINGER1),
  Adafruit_MQTT_Publish(&mqtt, AIO_USERNAME AIO_FEED_FINGER2),
  Adafruit_MQTT_Publish(&mqtt, AIO_USERNAME AIO_FEED_FINGER3),
  Adafruit_MQTT_Publish(&mqtt, AIO_USERNAME AIO_FEED_FINGER4),
  Adafruit_MQTT_Publish(&mqtt, AIO_USERNAME AIO_FEED_FINGER5)
};
Adafruit_MQTT_Publish sendfinger = Adafruit_MQTT_Publish(&mqtt, AIO_USERNAME AIO_FEED_FINGER0);
Adafruit_MQTT_Subscribe getfinger0 = Adafruit_MQTT_Subscribe(&mqtt, AIO_USERNAME AIO_FEED_FINGER0);

int flexValues[NO_FINGERS];


void setup() {
  Serial.begin(115200);
  delay(10);
  flex_init();

  connectToWifi();
  delay(5000);
  mqtt.subscribe(&getfinger0);

 
}

void loop() {

  // Read sensor values (replace with your sensor reading code)
  
  MQTTconnect();

  for (int i = 0; i < NO_FINGERS; i++) 
  {
    flexValues[i] = read_flex(i+1);
      if (sendData[i].publish(static_cast<uint32_t>(flexValues[i])))
        Serial.println("Finger " + String(i+1) + " " + String(flexValues[i]));
  }
/*
  if (sendfinger.publish(static_cast<uint32_t>(flexValues[0])))
        Serial.println("Finger 0 " + String(flexValues[0]));

  Adafruit_MQTT_Subscribe *subscription0;
  Serial.println("waiting for read");
  while (subscription0 = mqtt.readSubscription(5000)) {
    if (subscription0 == &getfinger0) 
    {
      Serial.print("Read Subscription0 ");
      Serial.println(subscription0->topic);
      Serial.print("Got: " + String((const char*)subscription0->lastread, subscription0->datalen) + "\n");

    }
  }
*/
  if (!mqtt.ping())  {
      mqtt.disconnect();
  }

  delay(5000); // Adjust the delay as needed
}
/// init
void flex_init()
{
  pinMode(FLEX_SENSOR1, INPUT);
  pinMode(FLEX_SENSOR2, INPUT);
  pinMode(FLEX_SENSOR3, INPUT);
  pinMode(FLEX_SENSOR4, INPUT);
  pinMode(FLEX_SENSOR5, INPUT);
}
/// Flex sensors
int read_flex(int num)
{
  //Serial.println("read_flex");
  switch (num){ 
    case 1:
      return analogRead(FLEX_SENSOR1);
        break;
    case 2:
      return analogRead(FLEX_SENSOR2);
        break;
    case 3:
      return analogRead(FLEX_SENSOR3);
        break;
    case 4:
      return analogRead(FLEX_SENSOR4);
        break;
    case 5:
      return analogRead(FLEX_SENSOR5);
        break;
  }
}
/// WIFI
void connectToWifi()
{
  Serial.print("Connecting to ");
  Serial.println(WLAN_SSID);
  WiFi.begin(WLAN_SSID, WLAN_PASS);
  while (WiFi.status() != WL_CONNECTED) {
    delay(500);
    Serial.print(".");
  }
  Serial.println();
  Serial.println("WiFi connected");
  Serial.println("IP address: "); 
  Serial.println(WiFi.localIP());
}
/// MQTT
void MQTTconnect() {
  if (mqtt.connected()) {
    return;
  }
  
  Serial.println("Connecting to MQTT server");
  uint8_t retries = 3;
  int8_t  ret;
  while ((ret = mqtt.connect()) != 0) 
  {
       Serial.println(mqtt.connectErrorString(ret));
       Serial.println("Retrying MQTT connection in 5 seconds");
       mqtt.disconnect();
       delay(5000); 
       retries--;
       if (retries == 0) {
         Serial.println("Connection failed");
         while (1);
       }
  }
  Serial.println("Connected to MQTT server");
}