#define echopin 5
#define TRIG 4
#define led_M 9
#define LED_K 7
#define LED_H 6
void setup() {
// put your setup code here, to run once:
pinMode(echopin,INPUT);
pinMode(TRIG, OUTPUT);
pinMode(led_M, OUTPUT);
pinMode(LED_K, OUTPUT);
pinMode(LED_H, OUTPUT);
}
void loop() {
// put your main code here, to run repeatedly
digitalWrite(TRIG, LOW);
delayMicroseconds(2);
digitalWrite(TRIG, HIGH);
delayMicroseconds(10);
digitalWrite(TRIG, LOW);
int durasi = pulseIn(echopin, HIGH);
float tinggi = (durasi / 2) / 29.25;
if(tinggi <= 50) {
digitalWrite(led_M, LOW);
digitalWrite( LED_K, LOW);
digitalWrite(LED_H, HIGH);
}else if(tinggi >=51 && tinggi<=100) {
digitalWrite(led_M, LOW);
digitalWrite( LED_K, HIGH);
digitalWrite(LED_H, LOW);
}else{
digitalWrite(led_M, HIGH);
digitalWrite( LED_K, LOW);
digitalWrite(LED_H, LOW);
}
}