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

Servo myservo1;
Servo myservo2;

#define merah 13
#define hijau 12
#define trig 5
#define echo 4
#define buzzer 9

LiquidCrystal_I2C lcd(0x27,16,2);

void setup() {
  // put your setup code here, to run once:
  myservo1.attach(11);
  myservo2.attach(10);

  pinMode(merah, OUTPUT);
  pinMode(hijau, OUTPUT);
  pinMode(trig, OUTPUT);
  pinMode(echo, INPUT);

  lcd.init();
  lcd.backlight();
  lcd.clear();
}

void loop() {
  // put your main code here, to run repeatedly:
  digitalWrite(trig, LOW);
  delayMicroseconds(2);
  digitalWrite(trig, HIGH);
  delayMicroseconds(10);
  digitalWrite(trig, LOW);
  long duration1 = pulseIn(echo, HIGH);
  float distance1 = duration1 /58.0;

  if (distance1 >= 20) {
    lcd.clear();
    lcd.setCursor(2,0);
    lcd.print("Pintu Garasi");
    lcd.setCursor(4,1);
    lcd.print("Tertutup");
    digitalWrite(buzzer, LOW);
    digitalWrite(merah, HIGH);
    digitalWrite(hijau, LOW);
    myservo1.write(0); 
    myservo2.write(180); 
  }
  else if (distance1 < 20) {
    lcd.clear();
    lcd.setCursor(0,0);
    lcd.print("Membuka Garasi");
    digitalWrite(buzzer, HIGH);
    digitalWrite(merah, LOW);
    digitalWrite(hijau, HIGH);
    myservo1.write(90);
    myservo2.write(90);
  }
  delay(1000);
}