#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");

String text = " Jarak : ";
String text2 = "1.Nabilla, 2.Erni, 3.Giraldin, 4.Kesya, 5.Intan" ;

for (int i = 0; i <= text.length() - 16; i++) {
lcd.clear();  
lcd.setCursor(0, 0);
lcd.print(text.substring (i, i + 16));
lcd.print(distance) ;
          
lcd.setCursor(0, 1);
lcd.print(text2.substring(i, i + 16)); 
}

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

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

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