int echoPin = 2;
int trigPin = 3;
int ledH = 4;
int ledK = 5;
int ledB = 6;
void setup() {
// put your setup code here, to run once:
pinMode(echoPin, INPUT);
pinMode(trigPin, OUTPUT);
pinMode(ledH, OUTPUT);
pinMode(ledK, OUTPUT);
pinMode(ledB, OUTPUT);
}
float ultrasonik(){
digitalWrite(trigPin, LOW);
delayMicroseconds(2);
digitalWrite(trigPin, HIGH);
delayMicroseconds(10);
digitalWrite(trigPin, LOW);
int durasiPantulan = pulseIn(echoPin, HIGH);
return durasiPantulan * 0.034 / 2;
}
void loop() {
// put your main code here, to run repeatedly:
float jarak = ultrasonik();
if(jarak>30){
digitalWrite(ledH, HIGH);
digitalWrite(ledK, LOW);
}
else if(jarak<=30 && jarak>5){
digitalWrite(ledK, HIGH);
digitalWrite(ledH, LOW);
digitalWrite(ledB, LOW);
}
else if(jarak<=5){
digitalWrite(ledB, HIGH);
digitalWrite(ledK, LOW);
}
}