SensorUltrasonik Arduino – Mengukur Jarak menggunakan LampuLed dengan arduino uno

SensorUltrasonik Arduino – Mengukur Jarak menggunakan LampuLed dengan arduino uno

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