#include <LiquidCrystal_I2C.h>
#include <ESP32Servo.h>
#include <Keypad.h>
LiquidCrystal_I2C lcd(0x27,20,4); 

Servo myservo;
const byte ROWS = 4;    
const byte COLS = 4;    

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

byte rowPins[ROWS] = { 19, 18, 5, 4}; 
byte colPins[COLS] = { 2, 15, 13, 12 };

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

Servo myservo1,myservo2,myservo3,myservo4,myservo5; 

char customKey;         
int number = 0;         
int password1 = 123;
int password2 = 234;
int password3 = 345;
int password4 = 456;
int password5 = 567;


void setup() {
  Serial.begin(9600);
  lcd.init ();              
  lcd.setBacklight(HIGH);
  myservo1.attach(14);
  myservo2.attach(27);
  myservo3.attach(26);
  myservo4.attach(25);
  myservo5.attach(33);
}

void loop() {
  lcd.setCursor(0,0);
  lcd.print("Masukkan Kode Loker");      
  
  customKey = customKeypad.getKey();    
  switch(customKey){
    case '0' ... '9':
      lcd.setCursor(0,1);
      number = number * 10 + (customKey - '0');
      lcd.print(number);
    break;
    case '#':
      if(number == password1){          
        lcd.setCursor(0,1);
        lcd.print("Access Accepted "); 
        myservo1.write(180);
        delay(5000);
        myservo1.write(90);
        number = 0;
        lcd.clear(); 
      }
      else if(number == password2){                        
        lcd.setCursor(0,1);
        lcd.print("Access Accepted "); 
        myservo2.write(180);
        delay(5000);
        myservo2.write(90);
        number = 0;
        lcd.clear(); 
      }
      else if (number == password3){
        lcd.setCursor(0,1);
        lcd.print("Access Accepted "); 
        myservo3.write(180);
        delay(5000);
        myservo3.write(90);
        number = 0;
        lcd.clear(); 
      }
      else if (number == password4){
        lcd.setCursor(0,1);
        lcd.print("Access Accepted "); 
        myservo4.write(180);
        delay(5000);
        myservo4.write(90);
        number = 0;
        lcd.clear(); 
      }
      else if (number == password5){
        lcd.setCursor(0,1);
        lcd.print("Access Accepted "); 
        myservo5.write(180);
        delay(5000);
        myservo5.write(90);
        number = 0;
        lcd.clear(); 
      }
      else {
        lcd.setCursor(0,1);
        lcd.print("Invalid Password");
      }
    break;
    case '*':
      number = 0;
      lcd.clear();
    break;
  }
}