#include "Adafruit_MQTT.h"
#include "Adafruit_MQTT_Client.h"
#include <WiFi.h>
/************************* Adafruit.io Setup *********************************/

#define AIO_SERVER      "io.adafruit.com" // io.adafruit.com
#define AIO_SERVERPORT  1883                   // use 8883 for SSL
#define AIO_USERNAME    "DaulynMorelJ"
#define AIO_KEY         "aio_CYMj06BxWjGp13BWV4Gyr3PbGhGL"

/************ Global State (you don't need to change this!) ******************/

// Create an ESP32 WiFiClient class to connect to the MQTT server.
WiFiClient client;

// Setup the MQTT client class by passing in the WiFi client and MQTT server and login details.
Adafruit_MQTT_Client mqtt(&client, AIO_SERVER, AIO_SERVERPORT, AIO_USERNAME, AIO_USERNAME, AIO_KEY);

/****************************** Feeds ***************************************/

// Notice MQTT paths for AIO follow the form: <username>/feeds/<feedname>
Adafruit_MQTT_Publish ultrasonico = Adafruit_MQTT_Publish(&mqtt, AIO_USERNAME "/feeds/mezclador.ultrasonico");
Adafruit_MQTT_Publish estado = Adafruit_MQTT_Publish(&mqtt, AIO_USERNAME "/feeds/mezclador.estado");
Adafruit_MQTT_Publish mensaje = Adafruit_MQTT_Publish(&mqtt, AIO_USERNAME "/feeds/mezclador.mensaje");


//-------------------VARIABLES GLOBALES--------------------------


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

unsigned long previousMillis = 0;

char charPulsador [15];
String strPulsador;
String strPulsadorUltimo;

const int Trigger = 27;   //Pin digital para el Trigger del sensor
const int Echo = 26;   //Pin digital para el Echo del sensor

#define WaterValve 33
#define DrainSensor 35
#define DrainValve 22
#define Mezclador 32

bool Mezclado= LOW;
//-------------------------------------------------------------------------

void setup() {

  pinMode(Trigger, OUTPUT); //pin como salida
  digitalWrite(Trigger, LOW);//Inicializamos el pin con 0
  
  // Entradas 
  pinMode(Echo, INPUT);  //pin como entrada
  pinMode(DrainSensor, INPUT);
  pinMode(WaterValve, OUTPUT);
  pinMode(DrainValve, OUTPUT);
  pinMode(Mezclador, OUTPUT);

  // Inicia Serial
  Serial.begin(115200);
  Serial.println("");


  WiFi.mode(WIFI_STA);
  WiFi.begin(ssid, password);
  while (WiFi.status() != WL_CONNECTED) {
    delay(500);
    Serial.print(".");
  }
}

//--------------------------LOOP--------------------------------
void loop() {

  MQTT_connect();

  unsigned long currentMillis = millis();
    
  if (currentMillis - previousMillis >= 3000) { //envia la distancia cada 3 segundos
    previousMillis = currentMillis;
    long t; //tiempo que demora en llegar el eco
    long d; //distancia en centimetros
    
  digitalWrite(Trigger, HIGH);
  delayMicroseconds(10);          //Enviamos un pulso de 10us
  digitalWrite(Trigger, LOW);
  
  t = pulseIn(Echo, HIGH); //obtenemos el ancho del pulso
  d = t/58.7;             //escalamos el tiempo a una distancia en cm
  
    int distancia = d;
    Serial.print(F("\nEnviando ultrasonico: "));
    Serial.print(distancia);
    Serial.print("cm ...");


    if (! ultrasonico.publish(distancia)) {
      Serial.println(F("Falló"));
    } else {
      Serial.println(F("OK!"));
    }
  delay(2000);
  int Porcentaje = 100 - distancia*100/200; //El 200 es el tamaño del tanque en cm
    Serial.print(F("\nEnviando Porcentaje: "));
    Serial.print(Porcentaje);
    Serial.print("% ...");
if (! estado.publish(Porcentaje)) {
      Serial.println(F("Falló"));
    } else {
      Serial.println(F("OK!"));
    }
    delay(2000);



        if (distancia >190 && Mezclado == LOW){
      mensaje.publish("Esperando Materias Primas");
      Serial.println("Esperando Materias Primas");
    }
    if (distancia >170 && distancia <=190 && Mezclado == LOW){
      mensaje.publish("Ingresando Materias Primas");
      Serial.println("Ingresando Materias Primas");
    }
    if (distancia >20 && distancia <=170 && Mezclado == LOW){
      mensaje.publish("Válvula de agua abierta");
      Serial.println("Válvula de agua abierta");
      digitalWrite(WaterValve, HIGH);
    }
    if (distancia <=20 && Mezclado == LOW){
      digitalWrite(WaterValve, LOW);
      mensaje.publish("Mezclando");
      Serial.println("Mezclando");
      digitalWrite(Mezclador, HIGH);
      delay(5000);
      digitalWrite(Mezclador, LOW);
      Mezclado= HIGH;
    }
    if (digitalRead(DrainSensor)){
    
    digitalWrite(DrainValve, HIGH);
    if(distancia>198){Mezclado= LOW; digitalWrite(DrainValve, LOW); }
    }
  }



  // this is our 'wait for incoming subscription packets and callback em' busy subloop
  // try to spend your time here:
  mqtt.processPackets(500);
  
  // ping the server to keep the mqtt connection alive
  // NOT required if you are publishing once every KEEPALIVE seconds
  
  // if(! mqtt.ping()) {
  //   mqtt.disconnect();
  // }
}

// Function to connect and reconnect as necessary to the MQTT server.
// Should be called in the loop function and it will take care if connecting.
void MQTT_connect() {
  int8_t ret;

  // Stop if already connected.
  if (mqtt.connected()) {
    return;
  }

  Serial.print("Connecting to MQTT... ");

  uint8_t retries = 3;
  while ((ret = mqtt.connect()) != 0) { // connect will return 0 for connected
       Serial.println(mqtt.connectErrorString(ret));
       Serial.println("Retrying MQTT connection in 10 seconds...");
       mqtt.disconnect();
       delay(10000);  // wait 10 seconds
       retries--;
       if (retries == 0) {
         // basically die and wait for WDT to reset me
         while (1);
       }
  }
  Serial.println("MQTT Connected!");
}