#include <LiquidCrystal_I2C.h>
#include <Servo.h>
LiquidCrystal_I2C lcd(0x27,16,2);
int trigPin = 11; //pin trigger
int echoPin = 10; //pin echo
long waktu; //Menghitung Waktu
int jarak; //Menghitung Jarak
Servo myservo;


void setup() {
  // put your setup code here, to run once:
Serial.begin(9600);
pinMode(trigPin, OUTPUT);
pinMode(echoPin, INPUT);
myservo.attach(9);
myservo.write(90);
lcd.init();
lcd.backlight();
lcd.setCursor(0,0);
lcd.print("ITL");
lcd.setCursor(0,1);
lcd.print("LOGHA");
delay(5000);
}

void loop() {
  // put your main code here, to run repeatedly:
lcd.clear();
digitalWrite(trigPin, LOW); //Mematikan trigger
delayMicroseconds(2);
digitalWrite(trigPin, HIGH); //Menyalakan trigger
delayMicroseconds(10);
digitalWrite(trigPin, LOW); //Mematikan trigger
waktu = pulseIn(echoPin, HIGH); // Membaca trigger diterima echopin
jarak = waktu * 0.034/2; // Menghitung jarak
lcd.setCursor(0,0);
lcd.print("JARAK OBYEK");
lcd.setCursor(0,1);
lcd.print("JARAK");
lcd.setCursor(4,1);
lcd.print("cm");
if(jarak < 20){
myservo.write(0);
delay(3000);
}
else{
myservo.write(180);
delay(3000);
}
delay(1000);

}