//Nama  : Hartanto Dwi Cahyadi
//NIM   : 2023310026P


#include <Servo.h>
#include <Wire.h>
#include <LiquidCrystal_I2C.h>

#define TRIG_PIN 9
#define ECHO_PIN 10
#define SERVO_PIN 6
#define LED_GREEN 2
#define LED_YELLOW 3
#define LED_RED 4

Servo servo;
LiquidCrystal_I2C lcd(0x27, 16, 2); // alamat I2C bisa berbeda, sesuaikan jika diperlukan

void setup() {
  pinMode(TRIG_PIN, OUTPUT);
  pinMode(ECHO_PIN, INPUT);
  pinMode(LED_GREEN, OUTPUT);
  pinMode(LED_YELLOW, OUTPUT);
  pinMode(LED_RED, OUTPUT);

  servo.attach(SERVO_PIN);
  
  lcd.begin(16, 2); // Menentukan jumlah kolom dan baris pada LCD
  lcd.backlight();

  Serial.begin(9600);
}

void loop() {
  long duration;
  float distanceCm;

  // Mengirimkan sinyal trigger ke sensor ultrasonik
  digitalWrite(TRIG_PIN, LOW);
  delayMicroseconds(2);
  digitalWrite(TRIG_PIN, HIGH);
  delayMicroseconds(10);
  digitalWrite(TRIG_PIN, LOW);

  // Membaca sinyal echo
  duration = pulseIn(ECHO_PIN, HIGH);
  distanceCm = (duration / 2) * 0.0343;

  // Mengatur kondisi berdasarkan ketinggian air
  if (distanceCm >= 30 && distanceCm <= 40) {
    // Kondisi normal
    digitalWrite(LED_GREEN, HIGH);
    digitalWrite(LED_YELLOW, LOW);
    digitalWrite(LED_RED, LOW);
    servo.write(10); // pintu air terbuka 10%
    lcd.clear();
    lcd.print("NORMAL");
  } else if (distanceCm > 60 && distanceCm <= 100) {
    // Kondisi waspada
    digitalWrite(LED_GREEN, LOW);
    digitalWrite(LED_YELLOW, HIGH);
    digitalWrite(LED_RED, LOW);
    servo.write(50); // pintu air terbuka 50%
    lcd.clear();
    lcd.print("WASPADA");
  } else if (distanceCm > 100) {
    // Kondisi bahaya
    digitalWrite(LED_GREEN, LOW);
    digitalWrite(LED_YELLOW, LOW);
    digitalWrite(LED_RED, HIGH);
    servo.write(100); // pintu air terbuka 100%
    lcd.clear();
    lcd.print("BAHAYA");
  } else {
    // Kondisi di bawah normal, pintu air tetap 10%
    digitalWrite(LED_GREEN, HIGH);
    digitalWrite(LED_YELLOW, LOW);
    digitalWrite(LED_RED, LOW);
    servo.write(10);
    lcd.clear();
    lcd.print("NORMAL");
  }

  // Menampilkan ketinggian air di LCD
  lcd.setCursor(0, 1);
  lcd.print("Tinggi: ");
  lcd.print(distanceCm);
  lcd.print(" cm");

  delay(1000); // Jeda 1 detik sebelum pembacaan berikutnya
}