#include <WiFi.h>
#include "Adafruit_MQTT.h"
#include "Adafruit_MQTT_Client.h"
#include <ArduinoJson.h>
#include <LiquidCrystal_I2C.h>
#include <ESP32Servo.h>
#define ssid "Wokwi-GUEST"
#define pass ""
#define server "io.adafruit.com"
#define port 1883
WiFiClient client;
LiquidCrystal_I2C lcd(0x27, 16, 2);
Adafruit_MQTT_Client mqtt(&client, server, port, user, key);
Adafruit_MQTT_Publish t_s1 = Adafruit_MQTT_Publish(&mqtt, user "/feeds/sw0");
Adafruit_MQTT_Publish t_s2 = Adafruit_MQTT_Publish(&mqtt, user "/feeds/sw1");
Adafruit_MQTT_Subscribe sw0 = Adafruit_MQTT_Subscribe(&mqtt, user "/feeds/sw0");
Adafruit_MQTT_Subscribe sw1 = Adafruit_MQTT_Subscribe(&mqtt, user "/feeds/sw1");
Adafruit_MQTT_Subscribe sw2 = Adafruit_MQTT_Subscribe(&mqtt, user "/feeds/sw2");
Adafruit_MQTT_Subscribe sw3 = Adafruit_MQTT_Subscribe(&mqtt, user "/feeds/sw3");
Adafruit_MQTT_Subscribe sw4 = Adafruit_MQTT_Subscribe(&mqtt, user "/feeds/sw4");
Adafruit_MQTT_Subscribe an1 = Adafruit_MQTT_Subscribe(&mqtt, user "/feeds/an1");
Adafruit_MQTT_Subscribe an2 = Adafruit_MQTT_Subscribe(&mqtt, user "/feeds/an2");
Adafruit_MQTT_Subscribe an3 = Adafruit_MQTT_Subscribe(&mqtt, user "/feeds/an3");
Adafruit_MQTT_Subscribe an4 = Adafruit_MQTT_Subscribe(&mqtt, user "/feeds/an4");
Servo servo;
int sa = 0;
int sb = 0;
int counter = 0;
void sw0callback(char *data, uint16_t len) {
  StaticJsonDocument<200> doc;
  deserializeJson(doc, data);
  int sw0 = doc["desired"]["sw0"];
  if (sw0) digitalWrite(4, HIGH);
  else digitalWrite(4, LOW);
}
void sw1callback(char *data, uint16_t len) {
  StaticJsonDocument<200> doc;
  deserializeJson(doc, data);
  int sw1 = doc["desired"]["sw1"];
  if (sw1) digitalWrite(16, HIGH);
  else digitalWrite(16, LOW);
}
void sw2callback(char *data, uint16_t len) {
  StaticJsonDocument<200> doc;
  deserializeJson(doc, data);
  int sw2 = doc["desired"]["sw2"];
  if (sw2) digitalWrite(17, HIGH);
  else digitalWrite(17, LOW);
}
void sw3callback(char *data, uint16_t len) {
  StaticJsonDocument<200> doc;
  deserializeJson(doc, data);
  int sw3 = doc["desired"]["sw3"];
  if (sw3) digitalWrite(5, HIGH);
  else digitalWrite(5, LOW);
}
void sw4callback(char *data, uint16_t len) {
  StaticJsonDocument<200> doc;
  deserializeJson(doc, data);
  int sw4 = doc["desired"]["sw4"];
  if (sw4) digitalWrite(18, HIGH);
  else digitalWrite(18, LOW);
}
void an1callback(char *data, uint16_t len) {
  StaticJsonDocument<200> doc;
  deserializeJson(doc, data);
  int an1 = doc["desired"]["an1"];
  servo.write(an1);
  Serial.println(an1);
  lcd.setCursor(4, 0);
  if (an1 < 10) lcd.print(" ");
  if (an1 < 100) lcd.print(" ");
  lcd.print(an1);
}
void an2callback(char *data, uint16_t len) {
  StaticJsonDocument<200> doc;
  deserializeJson(doc, data);
  int an2 = doc["desired"]["an2"];
  lcd.setCursor(12, 0);
  lcd.print(an2);
}
void an3callback(char *data, uint16_t len) {
  StaticJsonDocument<200> doc;
  deserializeJson(doc, data);
  int an3 = doc["desired"]["an3"];
  lcd.setCursor(4, 1);
  if (an3 < 10) lcd.print(" ");
  if (an3 < 100) lcd.print(" ");
  lcd.print(an3);
}
void an4callback(char *data, uint16_t len) {
  StaticJsonDocument<200> doc;
  deserializeJson(doc, data);
  int an4 = doc["desired"]["an4"];
  lcd.setCursor(12, 1);
  if (an4 < 10) lcd.print(" ");
  if (an4 < 100) lcd.print(" ");
  lcd.print(an4);
}
void MQTT_connect() {
  int8_t ret;
  if (mqtt.connected()) {
    return;
  }
  Serial.print("Connecting to MQTT... ");
  uint8_t retries = 0;
  while ((ret = mqtt.connect()) != 0) {
    Serial.println(mqtt.connectErrorString(ret));
    Serial.println("Retrying MQTT connection in 5 seconds...");
    mqtt.disconnect();
    delay(5000);
    retries++;
    Serial.printf("Intentos %s\n", retries);
    if (retries > 6) {
      ESP.restart();
    }
  }
  Serial.println("MQTT Connected!");
}
void setup() {
  Serial.begin(115200);
  Serial.print("Connecting to ");
  Serial.println(ssid);
  WiFi.begin(ssid, pass);
  while (WiFi.status() != WL_CONNECTED) {
    delay(500);
    Serial.print(".");
    if (counter > 10) {
      ESP.restart();
    }
    counter++;
  }
  Serial.println("WiFi connected");
  Serial.println("IP address: "); Serial.println(WiFi.localIP());
  servo.attach(19);
  lcd.init();
  lcd.backlight();
  lcd.setCursor(0, 0);
  lcd.print("an1:    an2:    ");
  lcd.setCursor(0, 1);
  lcd.print("an3:    an4:    ");
  pinMode(15, INPUT_PULLUP); //S1
  pinMode(2, INPUT_PULLUP); //S2
  pinMode(4, OUTPUT); //LED1
  pinMode(16, OUTPUT); //LED2
  pinMode(17, OUTPUT); //LED3
  pinMode(5, OUTPUT); //LED4
  pinMode(18, OUTPUT); //LED5
  pinMode(23, OUTPUT);//konveyor
  sw0.setCallback(sw0callback);
  sw1.setCallback(sw1callback);
  sw2.setCallback(sw2callback);
  sw3.setCallback(sw3callback);
  sw4.setCallback(sw4callback);
  an1.setCallback(an1callback);
  an2.setCallback(an2callback);
  an3.setCallback(an3callback);
  an4.setCallback(an4callback);
  mqtt.subscribe(&sw0);
  mqtt.subscribe(&sw1);
  mqtt.subscribe(&sw2);
  mqtt.subscribe(&sw3);
  mqtt.subscribe(&sw4);
  mqtt.subscribe(&an1);
  mqtt.subscribe(&an2);
  mqtt.subscribe(&an3);
  mqtt.subscribe(&an4);
  delay(1000);
}
void loop() {
  MQTT_connect();
  mqtt.processPackets(5000);
  if (! mqtt.ping()) {
    mqtt.disconnect();
  }
  int s1 = !digitalRead(15);
  int s2 = !digitalRead(2);
  if (s1 != sa) {
    Serial.println(s1);
    if (s1) t_s1.publish("1");
    else t_s1.publish("0");
  } sa = s1;
    if (s2 != sb) {
    Serial.println(s2);
    if (s2) t_s2.publish("1");
    else t_s2.publish("0");
  } sb = s2;
}