#include <LiquidCrystal_I2C.h>
#include <Servo.h>
Servo kran;
LiquidCrystal_I2C lcd (0x27, 16,2);
#define pinTrig 2
#define pinEcho 3
#define pinLed 1
float jarak;
long echoTime;
float tinggiJus;
void setup()
{
kran.attach(5);
kran.write(0);
lcd.init();
lcd.backlight();
pinMode(pinTrig, OUTPUT);
pinMode(pinEcho, INPUT);
digitalWrite(pinTrig, LOW);
}
void loop()
{
digitalWrite(pinTrig, HIGH);
delayMicroseconds(10);
digitalWrite(pinTrig, LOW);
echoTime = pulseIn(pinEcho, HIGH);
jarak = 0.0001*((float) echoTime * 340.0)/2.0;
tinggiJus = (30 - jarak);
if(tinggiJus>22){
digitalWrite(pinLed, LOW);
kran.write(90);
lcd.setCursor(0,1);
lcd.print("BOTOL PENUH");
}else{
digitalWrite(pinLed, HIGH);
kran.write(0);
lcd.clear();
lcd.setCursor(0,1);
lcd.print("MENGISI...");
}
lcd.setCursor (0,0);
lcd.print("Tinggi Jus: ");
lcd.print(tinggiJus);
lcd.print(" cm");
delay(500);
}