//M.ROBY 2022310034 UAS 


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

#define trigPin 9
#define echoPin 10
#define ledGreen 2
#define ledYellow 3
#define ledRed 4

LiquidCrystal_I2C lcd(0x27, 16, 2);
Servo servoMotor;

long duration;
int distance;

void setup() {
  pinMode(trigPin, OUTPUT);
  pinMode(echoPin, INPUT);
  pinMode(ledGreen, OUTPUT);
  pinMode(ledYellow, OUTPUT);
  pinMode(ledRed, OUTPUT);

  lcd.init();
  lcd.backlight();
  servoMotor.attach(5);

  Serial.begin(9600);
}

void loop() {
  digitalWrite(trigPin, LOW);
  delayMicroseconds(2);
  digitalWrite(trigPin, HIGH);
  delayMicroseconds(10);
  digitalWrite(trigPin, LOW);
  
  duration = pulseIn(echoPin, HIGH);
  distance = duration * 0.034 / 2;

  lcd.clear();
  lcd.setCursor(0, 0);
  lcd.print("Tinggi Air: ");
  lcd.print(distance);
  lcd.print(" cm");

  if (distance >= 30 && distance <= 40) {
    // Kondisi normal
    digitalWrite(ledGreen, HIGH);
    digitalWrite(ledYellow, LOW);
    digitalWrite(ledRed, LOW);
    lcd.setCursor(0, 1);
    lcd.print("NORMAL");
    servoMotor.write(10); // Pintu air terbuka 10%
  } else if (distance > 60 && distance <= 100) {
    // Kondisi waspada
    digitalWrite(ledGreen, LOW);
    digitalWrite(ledYellow, HIGH);
    digitalWrite(ledRed, LOW);
    lcd.setCursor(0, 1);
    lcd.print("WASPADA");
    servoMotor.write(90); // Pintu air terbuka 50%
  } else if (distance > 100) {
    // Kondisi bahaya
    digitalWrite(ledGreen, LOW);
    digitalWrite(ledYellow, LOW);
    digitalWrite(ledRed, HIGH);
    lcd.setCursor(0, 1);
    lcd.print("BAHAYA");
    servoMotor.write(180); // Pintu air terbuka 100%
  } else {
    // Kondisi lainnya (di bawah 30 cm atau NORMAL )
    digitalWrite(ledGreen, LOW);
    digitalWrite(ledYellow, LOW);
    digitalWrite(ledRed, LOW);
    lcd.setCursor(0, 1);
    lcd.print("NORMAL");
    servoMotor.write(0); // Pintu air tertutup
  }
  
  delay(1000); // Delay 1 detik sebelum pengukuran berikutnya
}