#include <WiFi.h>
#include <WiFiClient.h>
#include <LiquidCrystal_I2C.h>
#include <ESP32Servo.h>
#include <WiFi.h>
#include "ThingsBoard.h"
#include <MD_Parola.h>
#include <MD_MAX72xx.h>
#include <SPI.h>


#define PIN_TRIG2 18
#define PIN_ECHO2 19
#define PIN_TRIG 15
#define PIN_ECHO 2

#define pumpIn 4
#define pumpOut 26

#define HARDWARE_TYPE MD_MAX72XX::FC16_HW
#define MAX_DEVICES 4
#define CS_PIN 21

MD_Parola myDisplay = MD_Parola(HARDWARE_TYPE, CS_PIN, MAX_DEVICES);

#define CURRENT_FIRMWARE_TITLE    "UDANG"
#define CURRENT_FIRMWARE_VERSION  "1.0.0"

#define WIFI_SSID           "Wokwi-GUEST"
#define WIFI_PASSWORD       ""

#define TOKEN               "xJE4MVDLpITOT1WYezJv"
#define THINGSBOARD_SERVER  "165.232.163.250"

#define SERIAL_DEBUG_BAUD 115200

LiquidCrystal_I2C lcd(0x27,16,2);

// Initialize ThingsBoard client
WiFiClient espClient;
// Initialize ThingsBoard instance
ThingsBoard tb(espClient);
// the Wifi radio's status
int status = WL_IDLE_STATUS;

void volumePakan(){
  
  digitalWrite(PIN_TRIG2, HIGH);
  delayMicroseconds(10);
  digitalWrite(PIN_TRIG2, LOW);

  // Read the result:
  int durasi = pulseIn(PIN_ECHO2, HIGH);
  float pakan = durasi * 0.03400385 / 2/4;
  lcd.setCursor(0, 1);
  lcd.print("T.Pakan:");
  Serial.print("Ketersediaan Pakan (%): ");
  tb.sendTelemetryInt("Ketersediaan Pakan" ,pakan);
  Serial.println(pakan);
  lcd.setCursor(8,1);
  lcd.print(pakan);
  lcd.setCursor(14, 1);
  lcd.print("%");
  delay(100);
} 

void tinggiAir(){
  
  digitalWrite(PIN_TRIG, HIGH);
  delayMicroseconds(10);
  digitalWrite(PIN_TRIG, LOW);

  // Read the result:
  int duration = pulseIn(PIN_ECHO, HIGH);
  float water = duration * 0.03400385 / 2;
  lcd.setCursor(0, 0);
  lcd.print("T.Air:");
  Serial.print("Tinggi Air (Cm): ");
  Serial.println(water);
  lcd.setCursor(6,0);
  lcd.print(water);
  lcd.setCursor(13, 0);
  lcd.print("Cm");
  tb.sendTelemetryInt("Tinggi Air", water);
  delay(500);
} 
void pump(){
  digitalWrite(PIN_TRIG, HIGH);
  delayMicroseconds(10);
  digitalWrite(PIN_TRIG, LOW);

  // Read the result:
  int duration = pulseIn(PIN_ECHO, HIGH);
  float water = duration * 0.03400385 / 2;
  
  if(water<=250){
  digitalWrite(pumpIn,1);
  
  //tb.sendTelemetryInt("Pump IN",i );
  Serial.println("Menambahkan Air: Pompa IN Aktif");
  }
else{
  digitalWrite(pumpIn,0);
  Serial.println("Keran Masuk Tertutup:Pompa IN NonAktif");
  }
if(water>=350){
  digitalWrite(pumpOut,1);
  Serial.println("Membuang Air: Pompa Out Aktif");
  }
else{
  digitalWrite(pumpOut,0);
  Serial.println("Keran Buang Tertutup: Pompa Out NonAktif");
  }
}





void InitWiFi()
{
  Serial.println("Connecting to AP ...");
  // attempt to connect to WiFi network

  WiFi.begin(WIFI_SSID, WIFI_PASSWORD);
  while (WiFi.status() != WL_CONNECTED) {

    delay(500);
    Serial.print(".");
  }
  Serial.println("Connected to AP");
}

void reconnect() {
  // Loop until we're reconnected
  status = WiFi.status();
  if ( status != WL_CONNECTED) {
    WiFi.begin(WIFI_SSID, WIFI_PASSWORD);
    while (WiFi.status() != WL_CONNECTED) {
      delay(500);
      Serial.print(".");
    }
    Serial.println("Connected to AP");
  }
}


void setup() {
  myDisplay.begin();
	myDisplay.setIntensity(0);
	myDisplay.displayClear();
	myDisplay.displayScroll("Hello", PA_CENTER, PA_SCROLL_LEFT, 100);
  InitWiFi();
  lcd.init();
  lcd.backlight();
  Serial.begin(SERIAL_DEBUG_BAUD);
  pinMode(PIN_TRIG, OUTPUT);
  pinMode(PIN_ECHO, INPUT);
  pinMode(PIN_TRIG2, OUTPUT);
  pinMode(PIN_ECHO2, INPUT);
  pinMode(pumpIn, OUTPUT);
  pinMode(pumpOut, OUTPUT);
}

void loop() {

  if (WiFi.status() != WL_CONNECTED) {
    reconnect();
  }

  if (!tb.connected()) {
    // Connect to the ThingsBoard
    Serial.print("Connecting to: ");
    Serial.print(THINGSBOARD_SERVER);
    Serial.print(" with token ");
    Serial.println(TOKEN);
    if (!tb.connect(THINGSBOARD_SERVER, TOKEN)) {
      Serial.println("Failed to connect");
      return;
    }
  }

  tinggiAir();
  pump();
  volumePakan();
  tb.loop();

  tb.loop();
}