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

// Inisialisasi LCD dengan alamat 0x27 dan ukuran 16x2
LiquidCrystal_I2C lcd(0x27, 16, 2);

// Definisi pin sensor ultrasonik
const int trigPin = 23;
const int echoPin = 19;

long duration;
float distance;

void setup() {
  // Inisialisasi komunikasi serial dan LCD
  Serial.begin(9600);
  lcd.init();
  lcd.backlight();

  // Set mode pin
  pinMode(trigPin, OUTPUT);
  pinMode(echoPin, INPUT);

  // Pesan awal
  lcd.setCursor(0, 0);
  lcd.print("Sensor Ultrasonik");
  lcd.setCursor(0, 1);
  lcd.print("ESP32 + LCD I2C");
  delay(2000);
  lcd.clear();
}

void loop() {
  // Kirim sinyal trigger selama 10 microsecond
  digitalWrite(trigPin, LOW);
  delayMicroseconds(2);
  digitalWrite(trigPin, HIGH);
  delayMicroseconds(10);
  digitalWrite(trigPin, LOW);

  // Baca durasi pantulan sinyal
  duration = pulseIn(echoPin, HIGH);

  // Hitung jarak (kecepatan suara 0.034 cm/µs, dibagi 2 untuk pergi-pulang)
  distance = duration * 0.034 / 2;

  // Tampilkan hasil pada Serial Monitor dan LCD
  Serial.print("Jarak: ");
  Serial.print(distance);
  Serial.println(" cm");

  lcd.setCursor(0, 0);
  lcd.print("Jarak: ");
  lcd.print(distance);
  lcd.print(" cm   "); // Spasi untuk hapus angka lama

  delay(500);
}