#include <LiquidCrystal_I2C.h>
#include <Servo.h>
#include <Wire.h>

const int trig = 4;
const int echo = 3;
const int led = 2;

long waktu;
long jarak;

LiquidCrystal_I2C lcd(0x27, 16, 2);

Servo servo;

void setup() {
  servo.attach(11);

  pinMode(led, OUTPUT);
  pinMode(trig, OUTPUT);
  pinMode(echo, INPUT);

  lcd.init();
  lcd.backlight();
  lcd.setCursor(0, 0);
  
  digitalWrite(led, HIGH);
  delay(50);
  digitalWrite(led, LOW);

  lcd.print("Loading Data...");
  delay(500);
  lcd.clear();

}

void loop() {
  lcd.setCursor(0, 0);
  digitalWrite(trig, LOW);
  delayMicroseconds(2);
  digitalWrite(trig, HIGH);
  delayMicroseconds(10);
  digitalWrite(trig, LOW);

  waktu = pulseIn(echo, HIGH);

  jarak = waktu * 0.034 / 2;

  lcd.print(jarak);
  lcd.print("cm");

  if(jarak <= 180) {
    servo.write(90);
    digitalWrite(led, HIGH);
    delay(50);
    digitalWrite(led, LOW);
  } else {
    digitalWrite(led, HIGH);
    delay(50);
    digitalWrite(led, LOW);
    servo.write(0);
  }

delay(20);

}