// Deklarasi pin
const int trigPin = 9; // Pin untuk trig sensor HC-SR04
const int echoPin = 10; // Pin untuk echo sensor HC-SR04
const int redLed = 3; // Pin LED merah
const int yellowLed = 4; // Pin LED kuning
const int greenLed = 5; // Pin LED hijau
void setup() {
pinMode(trigPin, OUTPUT); // Trig sebagai output
pinMode(echoPin, INPUT); // Echo sebagai input
pinMode(redLed, OUTPUT); // LED merah sebagai output
pinMode(yellowLed, OUTPUT); // LED kuning sebagai output
pinMode(greenLed, OUTPUT); // LED hijau sebagai output
Serial.begin(9600); // Serial untuk debugging
}
void loop() {
// Mengirimkan sinyal ultrasonik
digitalWrite(trigPin, LOW);
delayMicroseconds(2);
digitalWrite(trigPin, HIGH);
delayMicroseconds(10);
digitalWrite(trigPin, LOW);
// Mengukur durasi pantulan sinyal
long duration = pulseIn(echoPin, HIGH);
// Menghitung jarak (dalam cm)
float distance = duration * 0.034 / 2;
// Debugging jarak
Serial.print("Distance: ");
Serial.print(distance);
Serial.println(" cm");
// Logika untuk mengontrol LED
if (distance < 10) {
digitalWrite(redLed, HIGH);
digitalWrite(yellowLed, LOW);
digitalWrite(greenLed, LOW);
} else if (distance >= 10 && distance <= 20) {
digitalWrite(redLed, LOW);
digitalWrite(yellowLed, HIGH);
digitalWrite(greenLed, LOW);
} else {
digitalWrite(redLed, LOW);
digitalWrite(yellowLed, LOW);
digitalWrite(greenLed, HIGH);
}
delay(500); // Delay untuk memperbarui pembacaan
}