#include <Servo.h>
Servo kran;
#define pinTrig 3
#define pinEcho 2
float distance;
long durasi;
float tinggiJus;
void setup() {
kran.attach(11);
kran.write(0);
pinMode(pinTrig, OUTPUT);
pinMode(pinEcho, INPUT);
digitalWrite(pinTrig, LOW);
}
void loop() {
digitalWrite(pinTrig, LOW);
delayMicroseconds(2);
digitalWrite(pinTrig, HIGH);
delayMicroseconds(10);
digitalWrite(pinTrig, LOW);
durasi= pulseIn(pinEcho, HIGH);
distance= 0.0001*((float)durasi*340)/2;
tinggiJus = 30- distance;
if (tinggiJus > 22) {
kran.write(0);
delay(1000);
} else {
kran.write(90);
}
delay(500);
}