#define trigPin 7
#define echoPin 6
#define ledAman 8
#define led1 9
#define led2 10
#define led3 11
void setup() {
// put your setup code here, to run once:
Serial.begin (9600);
pinMode (trigPin, OUTPUT);
pinMode (echoPin, INPUT);
pinMode (ledAman, OUTPUT);
pinMode (led1, OUTPUT);
pinMode (led2, OUTPUT);
pinMode (led3, OUTPUT);
}
void loop() {
// put your main code here, to run repeatedly:
long duration, distance;
digitalWrite(trigPin, LOW);
delayMicroseconds(10);
digitalWrite(trigPin, HIGH);
delayMicroseconds(10);
digitalWrite(trigPin, LOW);
delayMicroseconds(10);
duration = pulseIn(echoPin, HIGH);
distance =(duration/2) / 29.1;
Serial.println(distance); //distance adalah jarak
if (distance >= 20)
{
digitalWrite(ledAman, HIGH);
digitalWrite(led1, LOW);
digitalWrite(led2, LOW);
digitalWrite(led3, LOW);
}
else {
digitalWrite(ledAman, LOW);
}
if (distance <=19) //WARNA HIJAU
{
digitalWrite(led1, HIGH);
digitalWrite(led2, LOW);
digitalWrite(led3, LOW);
}
if (distance < 15) //WARNA KUNING
{
digitalWrite(led2, HIGH);
digitalWrite(led1, LOW);
digitalWrite(led3, LOW);
}
if (distance < 10) //WARNA MERAH
{
digitalWrite(led3, HIGH);
digitalWrite(led2, LOW);
digitalWrite(led1, LOW);
}
delay (500);
}