#include <WiFi.h>
#include <esp_wifi.h>
#include "DHTesp.h"
#include "ThingsBoard.h"
#include <RTClib.h>
#include <Wire.h>
#include <DS1307RTC.h>  // a basic DS1307 library that returns time as a time_t
#include <ESP32Servo.h>
#include <Adafruit_GFX.h>
#include <Adafruit_SSD1306.h>

#define CURRENT_FIRMWARE_TITLE    "TEST"
#define CURRENT_FIRMWARE_VERSION  "1.0.0"

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

#define ECHO_PIN 12
#define TRIG_PIN 13
#define ledTangki 4 //led tangki Pakan akan menyala apabila pakan akan habis
#define pelontar 5 //Pelontar disimulasikan dengan Relay dan LED
#define potensio 33 //Turbidity sensor disimulasikan dengan potensiometer
#define pompa 2 //Pompa pengontrol kekeruhan disimulasikan dengan Relay dan LED
const int DHT_PIN = 15;
const int tinggiTangki = 80;
Servo servoPakan; 

#define SCREEN_WIDTH 128  // OLED display width, in pixels
#define SCREEN_HEIGHT 64  // OLED display height, in pixels
#define OLED_RESET    -1  // Reset pin # (or -1 if sharing reset pin)
Adafruit_SSD1306 display(SCREEN_WIDTH, SCREEN_HEIGHT, &Wire, OLED_RESET);
 
RTC_DS1307 rtc;

//Jadwal Pemberian Pakan
int A1H = 18;  // Jam
int A1M = 04;  // Menit
int A1S = 10;  // Detik

int A2H = 18; // Jam
int A2M = 04; // Menit
int A2S = 20; // Detik

int A3H = 18; // Jam
int A3M = 04; // Menid
int A3S = 30; // Detik

int keruh=0;
DHTesp dhtSensor;

// See https://thingsboard.io/docs/getting-started-guides/helloworld/
// to understand how to obtain an access token
#define TOKEN               "KolamIkan2"

#define THINGSBOARD_SERVER  "thingsboard.cloud"

// Baud rate for debug serial
#define SERIAL_DEBUG_BAUD   115200

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

uint8_t newMACAddress[] = {0x32, 0xAE, 0xA4, 0x07, 0x0D, 0x98};
// uint8_t newMACAddress[] = {0x32, 0xAE, 0xA4, 0x07, 0x0D, 0x66};
// uint8_t newMACAddress[] = {0x32, 0xAE, 0xA4, 0x07, 0x0D, 0x66};

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() {
  // initialize serial for debugging
  Serial.begin(SERIAL_DEBUG_BAUD);
  Serial.println(); 
  InitWiFi(); 
  servoPakan.attach(32);
  pinMode(ledTangki, OUTPUT);
  pinMode(TRIG_PIN, OUTPUT);
  pinMode(ECHO_PIN, INPUT);
  pinMode(pelontar, OUTPUT);
  pinMode(potensio, INPUT);
  pinMode(pompa, OUTPUT);
  dhtSensor.setup(DHT_PIN, DHTesp::DHT22);

  Serial.print("[OLD] ESP32 Board MAC Address:  ");
  Serial.println(WiFi.macAddress());
  
  // ESP32 Board add-on before version < 1.0.5
  //esp_wifi_set_mac(ESP_IF_WIFI_STA, &newMACAddress[0]);
  
  // ESP32 Board add-on after version > 1.0.5
  esp_wifi_set_mac(WIFI_IF_STA, &newMACAddress[0]);
  
  Serial.print("[NEW] ESP32 Board MAC Address:  ");
  Serial.println(WiFi.macAddress());

  if (! rtc.begin()) {
    Serial.println("Couldn't find RTC");
    while (1);
  }
 
  if(!display.begin(SSD1306_SWITCHCAPVCC, 0x3C)) 
  { 
    Serial.println(F("SSD1306 allocation failed"));
    for(;;); // Don't proceed, loop forever
  }
 
  rtc.adjust(DateTime(F(__DATE__), F(__TIME__)));
    // manually sets the RTC with an explicit date & time, for example to set
    // January 21, 2021 at 3am you would call:
    // rtc.adjust(DateTime(2021, 1, 21, 3, 0, 0));
 
  display.display();
  delay(1000); 
  display.clearDisplay();
  display.setTextColor(WHITE);
  display.setTextSize(2);
  display.setCursor(5,5);
  display.print("Loading...");
  display.display();
  delay(1000);

}

void loop() {
  //delay(1000);
  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;
    }
  }
  
  Serial.println("Sending data...");

  DateTime now = rtc.now();
  display.clearDisplay();
  digitalClockDisplay(); //tampilkan jam di oled
  digitalDateDisplay();  //tampilkan tanggal di oled
 // display.display(); 

  if (now.hour() == A1H && now.minute() ==A1M && (now.second() == A1S) )
//Setting alarm/timer 
    { 
    feeding();
    }

  if (now.hour() == A2H && now.minute() == A2M && (now.second() == A2S) )
    { 
    feeding();
    }
  if (now.hour() == A3H && now.minute() == A3M && (now.second() == A3S) )
    { 
    feeding();
    }

  digitalWrite(TRIG_PIN, LOW);
  delayMicroseconds(2);
  digitalWrite(TRIG_PIN, HIGH);
  delayMicroseconds(10);
  digitalWrite(TRIG_PIN, LOW);
  int duration = pulseIn(ECHO_PIN, HIGH);
  float distance = duration * 0.034 / 2;
  float pakan= (tinggiTangki - distance)/tinggiTangki * 100;

  if (pakan >= 30 && pakan <= 100)
  {
    tb.sendTelemetryFloat("pakan", pakan);
    tb.sendTelemetryString("statusTangki", "Normal");
    digitalWrite(ledTangki, LOW);
  }
  else if (pakan < 30 && pakan >=0) {
    Serial.println("SEGERA ISI PAKAN");
    tb.sendTelemetryFloat("pakan", pakan);
    tb.sendTelemetryString("statusTangki", "Low");
    digitalWrite(ledTangki, HIGH);
  }
  else
  {
    Serial.println("Periksa Tutup Tangki Pakan");
    tb.sendTelemetryString("statusTangki", "Error");
    digitalWrite(ledTangki, HIGH);
  }

  float turbidity = 4.5 - analogRead(potensio)/1000;
  if (turbidity < 3.5 && keruh==0) 
  {
    Serial.println("Kekeruhan Tinggi, pompa dihidupkan");
    digitalWrite(pompa, HIGH);
    keruh=1;
    tb.sendAttributeBool("statusPompa", true);
  }
  else if (turbidity >= 3.5 && keruh==1)
  {
    Serial.println("Kekeruhan Normal, pompa dimatikan");
    digitalWrite(pompa, LOW);
    keruh=0;
    tb.sendAttributeBool("statusPompa", false);
  }
  TempAndHumidity  data = dhtSensor.getTempAndHumidity();
  tb.sendTelemetryFloat("turbidity", turbidity);
  tb.sendTelemetryInt("temperature", data.temperature);
  tb.sendTelemetryFloat("humidity", data.humidity);

  String jadwal1="";
  if (A1H < 10) 
    jadwal1= "0" + String(A1H) + ":";
    else jadwal1= String(A1H) + ":";
  if (A1M < 10) 
    jadwal1+= "0" + String(A1M) + ":";
    else jadwal1+= String(A1M) + ":"; 
  if (A1S < 10) 
    jadwal1+= "0" + String(A1S);
    else jadwal1+= String(A1S);

  String jadwal2="";
  if (A2H < 10) 
    jadwal2= "0" + String(A2H) + ":";
    else jadwal2= String(A2H) + ":";
  if (A2M < 10) 
    jadwal2+= "0" + String(A2M) + ":";
    else jadwal2+= String(A2M) + ":";
  if (A2S < 10) 
    jadwal2+= "0" + String(A2S);
    else jadwal2+= String(A2S);

  String jadwal3="";
  if (A3H < 10) 
    jadwal3= "0" + String(A3H) + ":";
    else jadwal3= String(A3H) + ":";
  if (A3M < 10) 
    jadwal3+= "0" + String(A3M) + ":";
    else jadwal3+= String(A3M) + ":";
  if (A3S < 10) 
    jadwal3+= "0" + String(A3S);
    else jadwal3+= String(A3S);

  char sch1[10];
  char sch2[10];
  char sch3[10];

  jadwal1.toCharArray( sch1, 10 );
  tb.sendTelemetryString("jadwal1", sch1);
  jadwal2.toCharArray( sch2, 10);
  tb.sendTelemetryString("jadwal2", sch2);
  jadwal3.toCharArray( sch3, 10);
  tb.sendTelemetryString("jadwal3", sch3);

  display.setTextSize(1);
  display.setCursor(5,20);
  display.print("Kekeruhan: ");
  display.print(turbidity);
  display.print(" V");

  display.setTextSize(1);
  display.setCursor(5,30);
  display.print("Temperatur: ");
  display.print(data.temperature);
  display.print("C");

  display.setTextSize(1);
  display.setCursor(5,10);
  display.print("Sisa Pakan: ");
  display.print(pakan,0);
  display.print("%");

  sch1ClockDisplay();
  sch2ClockDisplay();
  sch3ClockDisplay();
  display.display();
  delay(1000);

  tb.loop();

  tb.loop();
}

void digitalClockDisplay() {
  DateTime now = rtc.now();
  display.setTextSize(1);
  display.setCursor(5,0);
  display.print(now.hour());
  printDigits(now.minute());
  printDigits(now.second());
  display.println();
}

void sch1ClockDisplay() {
  display.setTextSize(1);
  display.setCursor(5,40);
  display.print("Jadwal 1: ");
  display.print(A1H);
  printDigits(A1M);
  printDigits(A1S);
  display.println();
}

void sch2ClockDisplay() {
  display.setTextSize(1);
  display.setCursor(5,48);
  display.print("Jadwal 2: ");
  display.print(A2H);
  printDigits(A2M);
  printDigits(A2S);
  display.println();
}

void sch3ClockDisplay() {
  display.setTextSize(1);
  display.setCursor(5,56);
  display.print("Jadwal 3: ");
  display.print(A3H);
  printDigits(A3M);
  printDigits(A3S);
  display.println();
}

void printDigits(int digits) {
  display.print(":");
  if (digits < 10)
    display.print('0');
  display.print(digits);
}

void digitalDateDisplay() {
  DateTime now = rtc.now();
  display.setTextSize(1);
  display.setCursor(65,0);
  display.print(now.year());
  printDigits2(now.month());
  printDigits2(now.day());
  display.println();
}

void printDigits2(int digits) {
  display.print("-");
  if (digits < 10)
    display.print('0');
  display.print(digits);
}

void feeding() {
  Serial.println("Eksekusi Pemberian Pakan");
  servoPakan.write(30);
  digitalWrite(pelontar, HIGH);
  Serial.println("Pelontar Start");
  tb.sendTelemetryInt("statusPelontar",1);
  delay(3000);
  servoPakan.write(90);
  delay(2000);
  digitalWrite(pelontar, LOW);
  Serial.println("Pelontar Stop");
  tb.sendTelemetryInt("statusPelontar",0);
}