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

#define buzzerPin 7 
#define trigPin 6   
#define echoPin 5   
#define greenPin 4  
#define yellowPin 3 
#define redPin 2    

LiquidCrystal_I2C lcd(0x27, 16, 2); 

void setup() {
  pinMode(trigPin, OUTPUT);
  pinMode(echoPin, INPUT);      
  pinMode(redPin, OUTPUT);      
  pinMode(yellowPin, OUTPUT);  
  pinMode(greenPin, OUTPUT);    
  pinMode(buzzerPin, OUTPUT);   
  Serial.begin(9600);           

  lcd.init();                   
  lcd.backlight();              
  lcd.setCursor(0, 0);         // Set kursor ke baris 0, kolom 0
  lcd.print("Jarak:     cm");  // Tampilkan teks "Jarak:     cm" di LCD
  lcd.setCursor(0, 1);         // Set kursor ke baris 1, kolom 0
  lcd.print(" aman ");    
}

void loop() {
  digitalWrite(trigPin, LOW);  // Set pin Trig ke LOW
  delayMicroseconds(2);        // Tunggu selama 2 
  digitalWrite(trigPin, HIGH); // Set pin Trig ke HIGH
  delayMicroseconds(10);       // Tunggu selama 10 mikrodetik
  digitalWrite(trigPin, LOW);  // Set pin Trig kembali ke LOW

  long waktu, jarak;           
  waktu = pulseIn(echoPin, HIGH); // untuk menyimpan durasi dari pulsa Echo yang diterima dari sensor ultrasonik.
  jarak = (waktu * 0.0343) / 2; // Menghitung jarak berdasarkan durasi

  Serial.print(jarak);        // Tampilkan jarak ke Serial Monitor
  Serial.println("cm");      

  lcd.setCursor(7, 0);       // Set kursor ke baris 0, kolom 7
  lcd.print("    ");         // Menghapus nilai sebelumnya di LCD
  lcd.setCursor(7, 0);       // Set kursor ke baris 0, kolom 7
  lcd.print(jarak);          // Tampilkan jarak di LCD

  digitalWrite(redPin, LOW);   
  digitalWrite(yellowPin, LOW); 
  digitalWrite(greenPin, LOW);  
  noTone(buzzerPin);            

  if (jarak >= 20 && jarak <= 30) {
    digitalWrite(greenPin, HIGH); 
    lcd.setCursor(0, 1);            // Set kursor ke baris 1, kolom 0
    lcd.print(" Aman ");  // Tampilkan "Status: Aman" di LCD
    tone(buzzerPin, 1000);           // Hidupkan buzzer dengan frekuensi 1000 Hz
    delay(300);                      // Tahan bunyi buzzer selama 300 ms
    noTone(buzzerPin);               
    delay(300);                     
  } else if (jarak >= 10 && jarak <= 20) {
    digitalWrite(yellowPin, HIGH);  // Hidupkan LED kuning
    lcd.setCursor(0, 1);            // Set kursor ke baris 1, kolom 0
    lcd.print(" Hati2");     
    tone(buzzerPin, 2000);           
    delay(200);                      // Tahan bunyi buzzer selama 200 ms
    noTone(buzzerPin);               
    delay(200);                      
  } else if (jarak >= 0 && jarak <= 10) {
    digitalWrite(redPin, HIGH);     
    lcd.setCursor(0, 1);            // Set kursor ke baris 1, kolom 0
    lcd.print("Awass !!");     
    tone(buzzerPin, 3000);           // Hidupkan buzzer dengan frekuensi 3000 Hz
  }
  delay(100); 
}