#include <WiFi.h> 
#include <WiFiClientSecure.h>
#include "ThingsBoard.h"
#include <PubSubClient.h>
#include <ESP32Servo.h>
#include "RTClib.h"
// #include <LiquidCrystal_I2C.h>
#include <UniversalTelegramBot.h>

//cek data baru setiap 1 detik
int botRequestDelay = 1000;
unsigned long lastTimeBotRan;

//definisi LCD
// LiquidCrystal_I2C lcd(0x27, 20, 4);

//definisi pin led
#define ledHijau 12
#define ledMerah 14

//definisi motor servo
Servo myServo;
int posisi = 0;
int sudutMax = 90;

//Definisi RTC
RTC_DS1307 rtc;
//Definisi Jadwal pakan ikan
//Jadwal pagi
const int JamMakan1 = 22;
const int MenitMakan1 = 18;
const int DetikMakan1 = 44;
//Jadwal siang
const int JamMakan2 = 22;
const int MenitMakan2 = 19;
const int DetikMakan2 = 00;
//Jadwal sore
const int JamMakan3 = 22;
const int MenitMakan3 = 19;
const int DetikMakan3 = 14;
//penghitung
int counter=0;
float persentaseSisaPakan=0;
//Definisi sensor ultrasonik
#define ECHO_PIN 2
#define TRIG_PIN 15
#define tinggiTabungPakan 100

//koneksi ke thingsboard
const char *ssid = "Wokwi-GUEST";
const char *password = "";

#define TOKEN "finalproject_token1234" //Access token of device Display
const char* mqtt_server = "thingsboard.cloud";

WiFiClient wifiClient;
PubSubClient client(wifiClient);
int status = WL_IDLE_STATUS;

// inisialisasi Telegram BOT
#define BOTtoken "5781210969:AAGOxQG2qi5TARFTtoG5TNek-VHoUWrcUJs" // diisi Token Bot (Dapat dari Telegram Botfather)
WiFiClientSecure wifiClientSecure;
UniversalTelegramBot bot(BOTtoken, wifiClientSecure);

void setup() {
  Serial.begin(115200);
  //lcd
  // lcd.init();
  // lcd.backlight();
  // lcd.setCursor(0, 0);
  // lcd.print("Feeder Machine");
  wifiClientSecure.setInsecure();
  //koneksi
  Serial.print(" Connect to : ");
  Serial.println(ssid);
  WiFi.begin(ssid, password);
  //  WiFi.config(IP, NETWORK, NETMASK, DNS);
  while (WiFi.status() != WL_CONNECTED)
  {
    delay(500);
    Serial.print("...");
  }
  Serial.print("\n");
  Serial.print("IP address : ");
  Serial.print(WiFi.localIP());
  Serial.print("\n");
  Serial.print("Connect to : ");
  Serial.println(ssid);
  client.setServer( mqtt_server, 1883);
  
  //HC-SR04
  pinMode(TRIG_PIN, OUTPUT);
  pinMode(ECHO_PIN, INPUT);

  //LED
  pinMode(ledHijau, OUTPUT);
  pinMode(ledMerah, OUTPUT);

  //Servo
  myServo.attach(13);
  myServo.write(posisi); 

  //RTC
  if (! rtc.begin()) { //bila RTC tidak terhubung
    Serial.println("Couldn't find RTC");
    Serial.flush();
    while (1) delay(10);
  }

  if (! rtc.isrunning()) { //bila RTC tidak jalan maka set waktu
    Serial.println("RTC is NOT running, let's set the time!");
    // ketika set waktu diperlukan untuk alat baru, atau saat power loss,
    // berikut ini set waktu saat sketch ini di-compile
    rtc.adjust(DateTime(F(__DATE__), F(__TIME__)));
    // bila ingin set ke waktu spesifik, misalnya
    // January 21, 2014 pada jam 3am maka digunakan
    // rtc.adjust(DateTime(2014, 1, 21, 3, 0, 0));
  }
}

void pengukuranSisaPakan() {
  //Sensor ultrasonik mengkondisikan impuls
  digitalWrite(TRIG_PIN, LOW);
  delayMicroseconds(2);
  digitalWrite(TRIG_PIN, HIGH);
  delayMicroseconds(10);
  digitalWrite(TRIG_PIN, LOW);
  int durasi = pulseIn(ECHO_PIN, HIGH);
  float jarakPakanDariAtas = durasi * 0.034 / 2;
  //misal tinggi tabung pakan sesuai definisi awal
  float ketinggianPakan = tinggiTabungPakan - jarakPakanDariAtas;
  float persentaseSisaPakan = (ketinggianPakan) * 100 / tinggiTabungPakan;
  Serial.print("Tinggi sisa pakan: ");
  Serial.print(ketinggianPakan);
  Serial.println(" cm");
  Serial.print("Persentase sisa pakan: ");
  Serial.print(persentaseSisaPakan);
  Serial.println(" %");
  //delay(100);

  //display sisa pakan ke lcd
  // lcd.setCursor(0, 3);
  // lcd.print("Sisa pakan : ");
  // lcd.print(persentaseSisaPakan);
  // lcd.println(" %");

    if (persentaseSisaPakan >  0) {
    digitalWrite(ledHijau, HIGH);
    digitalWrite(ledMerah, LOW);
  }
  if (persentaseSisaPakan == 0) {
    digitalWrite(ledMerah, HIGH);
    digitalWrite(ledHijau, LOW);
  }
  //Stok pakan
  String payload1 = "{";
  payload1 += "\"StokPakanIkan\":"; payload1 += persentaseSisaPakan;
  payload1 += "}";

  char attributes1[1000];
  payload1.toCharArray( attributes1, 1000 );
  client.publish( "v1/devices/me/telemetry", attributes1);
  client.publish( "v1/devices/me/attributes", attributes1);
  Serial.println( attributes1 );
}
void pergerakanServo() {
  for (posisi = 0; posisi <= sudutMax; posisi ++) {
    myServo.write(posisi);
    delay(15);
  }
  for (posisi = sudutMax; posisi >= 0; posisi --) {
    myServo.write(posisi);
    delay(15);
  }
  counter=counter+1;
  Serial.println("Ikan diberi makan");
  if(counter>3){
    counter=0;
  }
  Serial.print("Total: ");
  Serial.print(counter);
  Serial.println(" kali.");

  //display total makan ke lcd
  // lcd.setCursor(0,2);
  // lcd.print("Total Makan : ");
  // lcd.print(counter);
  // lcd.println(" kali.");

  //Total counter
  String payload2 = "{";
  payload2 += "\"Total makan\":"; payload2 += counter;
  payload2 += "}";

  char attributes2[1000];
  payload2.toCharArray( attributes2, 1000 );
  client.publish( "v1/devices/me/telemetry", attributes2);
  client.publish( "v1/devices/me/attributes", attributes2);
  Serial.println( attributes2 );
}

void handleNewMessages(int numNewMessages) {
  Serial.println("handleNewMessages");
  Serial.println(String(numNewMessages));

  for (int i=0; i<numNewMessages; i++) {
    String chat_id = String(bot.messages[i].chat_id);
    String text = bot.messages[i].text;

    String from_name = bot.messages[i].from_name;
    if (from_name == "") from_name = "Guest";
 
    //Cek pembacaan Total Makan
    if (text == "/totalMakan") {
       String showTotalMakan = "Total Makan : ";
       showTotalMakan += (counter);
       showTotalMakan +=" Kali";
      
      bot.sendMessage(chat_id,showTotalMakan, "");
    }

    //cek pembacaan sisa pakan
    if (text == "/sisaPakan") {
       String showSisaPakan = "Sisa Pakan : ";
       showSisaPakan += (persentaseSisaPakan);
       showSisaPakan += " %";
     
      bot.sendMessage(chat_id,showSisaPakan, "");
    }
    
    //Cek Command untuk setiap aksi
    if (text == "/start") {
      String welcome = "Welcome  " + from_name + ".\n";
      welcome += "/totalMakan : Total Pakan\n";
      welcome += "/sisaPakan : Sisa Pakan\n";
      bot.sendMessage(chat_id, welcome, "Markdown");
    }
  }
}

void loop() {
  //cek waktu sekarang
  DateTime time = rtc.now();
  Serial.print("Saat ini pukul: ");
  Serial.print(time.hour(), DEC);
  Serial.print(':');
  Serial.print(time.minute(), DEC);
  Serial.print(':');
  Serial.print(time.second(), DEC);
  Serial.println();

  //cek waktu sekarang di lcd
  // lcd.setCursor(0,1);
  // lcd.print("Pukul : ");
  // lcd.print(time.hour(), DEC);
  // lcd.print(':');
  // lcd.print(time.minute(), DEC);
  // lcd.print(':');
  // lcd.print(time.second(), DEC);
  // lcd.println();


  //set the time for fish feeding
  if ((time.hour() == JamMakan1 && time.minute() == MenitMakan1 && time.second() == DetikMakan1) || (time.hour() == JamMakan2 && time.minute() == MenitMakan2 && time.second() == DetikMakan2) || (time.hour() == JamMakan3 && time.minute() == MenitMakan3 && time.second() == DetikMakan3)) {
    pergerakanServo();
    pengukuranSisaPakan();
  }
  if ( !client.connected() )
  {
    reconnect();
  }
  
  delay(1000);

  //update pesan di telegram
  if (millis() > lastTimeBotRan + botRequestDelay)  {
    int numNewMessages = bot.getUpdates(bot.last_message_received + 1);

    while(numNewMessages) {
      Serial.println("got response");
      handleNewMessages(numNewMessages);
      numNewMessages = bot.getUpdates(bot.last_message_received + 1);
    }

    lastTimeBotRan = millis();
  }
}


void reconnect() {
  // Loop until we're reconnected
  while (!client.connected()) {
    status = WiFi.status();
    if ( status != WL_CONNECTED) {
      WiFi.begin(ssid, password);
      while (WiFi.status() != WL_CONNECTED) {
        delay(500);
        Serial.print(".");
      }
      Serial.println("Connected to AP");
    }
    Serial.print("Connecting to ThingsBoard node ...");
    // Attempt to connect (clientId, username, password)
    if ( client.connect("3a90f960-1ad1-11ed-b480-cbe4cea4aa70", TOKEN, "") ) {
      Serial.println( "[DONE]" );
    } else {
      Serial.print( "[FAILED] [ rc = " );
      Serial.println( " : retrying in 5 seconds]" );
      delay( 500 );
    }
  }
}