#include "DHTesp.h"
#include <LiquidCrystal_I2C.h>

#define PIN_TRIG 13
#define PIN_ECHO 12

#define I2C_ADDR 0x27
#define LCD_COLUMNS 16
#define LCD_LINES 2

#define RELAY_MDL 14

const int DHT_PIN = 15;

const int ENABLE_PIN_SMD1 = 25;
const int STEP_PIN_SMD1 = 26;
const int DIR_PIN_SMD1 = 27;
const int STEPS_REVOLUTION_SMD1 = 200;

const int ENABLE_PIN_SMD2 = 4;
const int STEP_PIN_SMD2 = 18;
const int DIR_PIN_SMD2 = 19;
const int STEPS_REVOLUTION_SMD2 = 200;

DHTesp dhtSensor;

LiquidCrystal_I2C lcd(I2C_ADDR, LCD_COLUMNS, LCD_LINES);

void setup() {
  Serial.begin(115200);

  // Initialize Ultrasonic Sensor 
  pinMode(PIN_TRIG, OUTPUT);
  pinMode(PIN_ECHO, INPUT);

  // Initialize DHT Sensor using library
  dhtSensor.setup(DHT_PIN, DHTesp::DHT22);

  // Initialize LCD
  lcd.init();
  lcd.backlight();
  lcd.clear();

  // Initialize relay module
  pinMode(RELAY_MDL, OUTPUT);

  // Initialize A4988 Stepper Motor Driver Left
  pinMode(ENABLE_PIN_SMD1, OUTPUT);
  pinMode(STEP_PIN_SMD1, OUTPUT);
  pinMode(DIR_PIN_SMD1, OUTPUT);

  // Initialize A4988 Stepper Motor Driver Right
  pinMode(ENABLE_PIN_SMD2, OUTPUT);
  pinMode(STEP_PIN_SMD2, OUTPUT);
  pinMode(DIR_PIN_SMD2, OUTPUT);
}


void loop() {
  // Start water level measurement:
  digitalWrite(PIN_TRIG, HIGH);
  delayMicroseconds(10);
  digitalWrite(PIN_TRIG, LOW);

  // Read water level result:
  int duration = pulseIn(PIN_ECHO, HIGH);
  Serial.print("Ketinggian air: ");
  int waterLevel = duration / 58;
  Serial.print(waterLevel);
  Serial.println(" cm");

  //Humidity measurement & read result :
  TempAndHumidity  data = dhtSensor.getTempAndHumidity();
  Serial.println("Kelembapan : " + String(data.humidity, 1) + "%");

  //LCD Output Humidity & Water Level
  lcd.clear();

  lcd.setCursor(0, 0);
  lcd.print("Tinggi air:" + String(waterLevel) + "cm");
  lcd.setCursor(0, 1);
  lcd.print("Humiditas:" + String(data.humidity, 1) + "% ");

  //LED Warning for Humidity
  if (data.humidity >= 0 && data.humidity <= 39) {
    digitalWrite(RELAY_MDL, LOW);
    Serial.println("Kelembapan Tanah Kering");
  } else if (data.humidity >= 61 && data.humidity <= 100) {
    digitalWrite(RELAY_MDL, LOW);
    Serial.println("Kelembapan Tanah Terlalu Basah");
  } else if (data.humidity >= 40 && data.humidity <= 60) {
    digitalWrite(RELAY_MDL, HIGH);
    Serial.println("Kelembapan Tanah Ideal");
  } else {
    Serial.println("Sensor Kelembapan Error");
  }

  Serial.println("---");


  if (data.humidity >= 0 && data.humidity <= 39) {
    digitalWrite(ENABLE_PIN_SMD2, HIGH);
    for (int x = 0; x < STEPS_REVOLUTION_SMD1; x++){
      digitalWrite(STEP_PIN_SMD2, HIGH);
      delayMicroseconds(2000);
      digitalWrite(STEP_PIN_SMD2, LOW);
      delayMicroseconds(2000);
    }
  } 


  delay(2000);
}