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

LiquidCrystal_I2C lcd(0x27,20,4);  

const byte ROWS = 4;    
const byte COLS = 4;
int echo = 11;
int trig = 12; 

char Keys[ROWS][COLS] = {   
  {'1','2','3','A'},
  {'4','5','6','B'},
  {'7','8','9','C'},
  {'*','0','#','D'}
};

byte rowPins[ROWS] = { 10, 9, 8, 7 }; 
byte colPins[COLS] = { 6, 5, 4, 3 };

Keypad customKeypad = Keypad( makeKeymap(Keys), rowPins, colPins, ROWS, COLS);    //Masukkan info keypad pada library
Servo servo1;

char customKey;         
int number = 0;         
int password = 1122;   
int redPin = 13;  
int greenPin = 12;
long dur, dis;
int servoPin = 2;
bool flag;  
void setup() {
  lcd.init ();              
  lcd.setBacklight(HIGH);  
  pinMode(redPin, OUTPUT);  
  pinMode(greenPin, OUTPUT);
  servo1.attach(servoPin);
  pinMode(trig, OUTPUT);
  pinMode(echo,INPUT);
  flag = true;
}

void loop() {
  
  lcd.setCursor(0,0);
  lcd.print("Input Password");
  
  customKey = customKeypad.getKey();    

  //------------Prosedur jika input berupa angka------------//
  switch(customKey){
    case '0' ... '9':
      lcd.setCursor(0,1);
      number = number * 10 + (customKey - '0');
      lcd.print(number);
    break;

    //------------Jika input '#' maka cek password------------//
    case '#':
      if(number == password && flag==true){           
        lcd.setCursor(0,1);
        lcd.print("Access Accepted "); 
        digitalWrite(redPin, LOW);  
        digitalWrite(greenPin, HIGH);  
        number = 0;
        delay(1000);
        lcd.clear();   
        digitalWrite(greenPin, LOW);
        servo1.write(0);
        flag=false;
        
        while(flag==false){
          digitalWrite(trig,LOW);
          delayMicroseconds(2);

          digitalWrite(trig, HIGH);
          delayMicroseconds(10);
          digitalWrite(trig, LOW);

          dur = pulseIn(echo,HIGH);
          dis = dur/58.2;
          lcd.setCursor(0,1);
          lcd.print("Pintu: Terbuka");
          lcd.setCursor(1,0);
          lcd.print(dis);
          servo1.write(0);
          if(dis>100){
            delay(2000);
            servo1.write(90);
            lcd.setCursor(0,1);
            lcd.print("Pintu: Tertutup");
            lcd.setCursor(1,0);
            lcd.print(dis);
            delay(1000);
            lcd.clear();
            flag=true;
            break;
          }
        }
      
      }
      else{                             
        lcd.setCursor(0,1);
        lcd.print("Password Salah");  
        digitalWrite(redPin, HIGH);  
        digitalWrite(greenPin, LOW);
        number = 0;
        delay(1000);
        lcd.clear();
        digitalWrite(redPin, LOW); 
      }
    break;
    

    //------------Jika input '*' maka hapus tampilan------------//
    case '*':
      number = 0;
      lcd.clear();
    break;
  }
}