const int trigPin = D5;
const int echoPin = D6;
const int relayPin = D7;

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

void setup() {
  // Inisialisasi pin
  pinMode(trigPin, OUTPUT);
  pinMode(echoPin, INPUT);
  pinMode(relayPin, OUTPUT);

  // Inisialisasi serial monitor (untuk debugging)
  Serial.begin(115200);
  digitalWrite(relayPin, LOW); // Lampu mati awalnya
}

void loop() {
  // Bersihkan trigPin
  digitalWrite(trigPin, LOW);
  delayMicroseconds(2);
  
  // Kirim pulsa trigger selama 10µs
  digitalWrite(trigPin, HIGH);
  delayMicroseconds(10);
  digitalWrite(trigPin, LOW);

  // Baca durasi waktu pulsa echo
  duration = pulseIn(echoPin, HIGH);
  
  // Hitung jarak (dalam cm)
  distance = duration * 0.034 / 2;

  // Tampilkan jarak di Serial Monitor
  Serial.print("Jarak: ");
  Serial.print(distance);
  Serial.println(" cm");

  // Logika kontrol lampu
  if (distance < 50) { // Jika jarak kurang dari 50 cm
    digitalWrite(relayPin, HIGH); // Nyalakan lampu
  } else {
    digitalWrite(relayPin, LOW); // Matikan lampu
  }

  // Tunggu sebentar sebelum membaca lagi
  delay(500);
}