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

// Inisialisasi LCD12C
LiquidCrystal_I2C lcd(0x27, 16, 2);

//Definisi pin untuk sensor ultrasonik
const int trigPin =13;
const int echoPin = 12;

// Pin untuk LED
const int redPin = 2;
const int yellowPin = 26;
const int greenPin = 32;

//pin untuk buzzer
const int buzzerPin = 14;

//Variabel untuk menyimpan jarak
long duration;
int distance;

void setup(){

// Inisialisasi pin LED
  pinMode(redPin, OUTPUT);
  pinMode(yellowPin, OUTPUT);
  pinMode(greenPin, OUTPUT);

//Inisialisasi Serial Monitor
Serial.begin(9600);

//Set pin untuk sensor ultrasonik
pinMode (trigPin, OUTPUT);
pinMode (echoPin, INPUT);

 // Inisialisasi LCD12C
  lcd.init();
  lcd.backlight();

  //Inisialisasi pin buzzer
  pinMode(buzzerPin,OUTPUT);



}


void loop(){
//Mengirimkan sinyal ultrasonik
digitalWrite(trigPin,LOW) ;
delayMicroseconds(2) ;
digitalWrite(trigPin, HIGH);
delayMicroseconds(10);
digitalWrite(trigPin, LOW) ;

// Mengukur waktu yang dibutuhkan sinyal untuk kembali
duration =pulseIn (echoPin, HIGH);


// Menghitung jarak (cm)
distance = duration * 0.034 / 2;

// Меnampilkan jarak pada Serial Monitor
Serial.print("Jarak: ");
Serial.print(distance);
Serial.println("cm");

// Tampilkan jarak pada LCD12C
lcd.clear();
lcd.setCursor(0, 0);
lcd.print("Jarak: ");
lcd.print(distance);
lcd.print(" cm");
lcd.setCursor(0,1);
lcd.print("Bila,Giral,Intan");

  // Kontrol LED berdasarkan jarak
  if (distance > 30) {
    digitalWrite(greenPin, HIGH);
    digitalWrite(redPin, LOW);
    digitalWrite(yellowPin, LOW);
  } else if (distance >= 14 && distance <= 29) {
    digitalWrite(greenPin, LOW);
    digitalWrite(redPin, LOW);
    digitalWrite(yellowPin, HIGH);
  } else if (distance >= 0 && distance < 14) {
    digitalWrite(greenPin, LOW);
    digitalWrite(redPin, HIGH);
    digitalWrite(yellowPin, LOW);
  } 

  // Kontrol buzzer berdasarkan jarak
  if (distance < 14){
    tone(buzzerPin,1000);//Frekuensi 1000 Hz
  }else{
    noTone(buzzerPin);
  }

//delay untuk pembaruan data
delay(500);
}