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

//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 = 15;
const int MenitMakan1 = 24;
const int DetikMakan1 = 00;
//Jadwal siang
const int JamMakan2 = 15;
const int MenitMakan2 = 24;
const int DetikMakan2 = 1;
//Jadwal sore
const int JamMakan3 = 15;
const int MenitMakan3 = 24;
const int DetikMakan3 = 30;
//penghitung
int counter=0;
//Definisi sensor ultrasonik
#define ECHO_PIN 2
#define TRIG_PIN 15
#define tinggiTabungPakan 100


//setInterval untuk servo
unsigned long saatAwal = 0;
unsigned long saatIni;
const long interval = 200;
/*/untukRTC
  unsigned long saatAwalRTC = 0;
  unsigned long saatIniRTC;
  const long intervalRTC = 1000;*/

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

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

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


void setup() {
  Serial.begin(115200);
  //lcd
  lcd.init();
  lcd.backlight();
  lcd.setCursor(0, 0);
  lcd.print("Feeder Machine");
  //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 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);
}


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 );
    }
  }
}