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

// Alamat I2C dari LCD
int i2c_address = 0x27; // Anda mungkin perlu mengganti ini sesuai dengan alamat LCD Anda

// Inisialisasi objek LCD
LiquidCrystal_I2C lcd(i2c_address, 16, 2); // 16 kolom, 2 baris

// Deklarasi PIN
int trig = 6;
int echo = 7;
long durasi;
int jarak;
int merah = 4;
int kuning = 3;
int hijau = 2;
int buzzer = 5;

void setup() {
  // Mengatur pin sebagai OUTPUT atau INPUT
  pinMode(trig, OUTPUT);
  pinMode(echo, INPUT);
  pinMode(merah, OUTPUT);
  pinMode(kuning, OUTPUT);
  pinMode(hijau, OUTPUT);
  pinMode(buzzer, OUTPUT);
  Serial.begin(9600);
  
  // Menginisialisasi LCD
  lcd.init();
  lcd.backlight(); // Menyalakan backlight LCD
  lcd.setCursor(0, 0); // Posisi awal cursor
  lcd.print("Jarak Berada di :"); // Menampilkan judul
}

void loop() {
  // Mengukur jarak menggunakan sensor ultrasonik
  digitalWrite(trig, LOW);
  delayMicroseconds(2);
  digitalWrite(trig, HIGH);
  delayMicroseconds(10);
  digitalWrite(trig, LOW);
  durasi = pulseIn(echo, HIGH);
  jarak = (durasi / 2) / 29.1;
  
  // Menampilkan jarak di LCD
  lcd.setCursor(0, 1); // Posisi cursor LCD baris kedua
  lcd.print("                "); // Membersihkan tampilan jarak sebelumnya
  lcd.setCursor(0, 1); // Posisi cursor LCD baris kedua
  lcd.print(jarak); // Menampilkan jarak

  // Menampilkan status warna berdasarkan jarak
  lcd.setCursor(6, 1); // Posisi cursor LCD untuk status warna
  if (jarak >= 150) {
    lcd.print(" Hijau "); // Menampilkan status hijau jika jarak >= 150
  } else if (jarak > 100 && jarak < 150) {
    lcd.print(" Kuning"); // Menampilkan status kuning jika 100 < jarak < 150
  } else {
    lcd.print(" Merah "); // Menampilkan status merah jika jarak < 100
  }
  
  // Memutuskan tindakan berdasarkan jarak
  if (jarak >= 150) {
    digitalWrite(hijau, HIGH);
    digitalWrite(merah, LOW);
    digitalWrite(kuning, LOW);
    digitalWrite(buzzer, LOW);
  } else if (jarak > 100 && jarak < 150) {
    digitalWrite(hijau, LOW);
    digitalWrite(merah, LOW);
    digitalWrite(kuning, HIGH);
    digitalWrite(buzzer, LOW);
  } else {
    digitalWrite(hijau, LOW);
    digitalWrite(merah, HIGH);
    digitalWrite(kuning, LOW);
    digitalWrite(buzzer, HIGH);
  }

  delay(500); // Memberikan jeda agar tidak terlalu sering membaca jarak
}