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