#include<Servo.h>
#include <Wire.h>
#include <LiquidCrystal_I2C.h>
Servo servo; 
LiquidCrystal_I2C lcd (0x27, 16, 2);

int const trigPin = 6; 
int const echoPin = 5; 

void setup() {
  pinMode(trigPin, OUTPUT);
  pinMode(echoPin, INPUT);
  servo.attach(3);
  
  lcd.begin(16, 2);
  lcd.setCursor(0,0);
}

void loop() {
  int duration, distance;
  digitalWrite(trigPin, HIGH);
  delay(1);
  digitalWrite(trigPin, LOW);
  duration = pulseIn(echoPin, HIGH);
  distance = (duration / 2) / 29/1;

  if (distance <= 50 && distance >= 0){
    servo.write(180);
    lcd.print("Terbuka");
    delay(3000);
    lcd.clear();
  } else {
    servo.write(90);
    lcd.print("Tertutup");
  }
delay(60);
lcd.clear();


}