#include <Keypad.h>                 //Library keypad
#include <LiquidCrystal_I2C.h>    //Library LCD I2C
#include <ESP32Servo.h>
LiquidCrystal_I2C lcd(0x27,16,2);   //Alamat I2C

Servo gerak1;
Servo gerak2;
Servo gerak3;

int pos = 0;

const byte ROWS = 4;    //Jumlah baris keypad
const byte COLS = 4;    //Jumlah kolom keypad

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

byte rowPins[ROWS] = { 23, 0, 19, 18 }; 
byte colPins[COLS] = { 5, 17, 16, 4 };

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


char customKey;         //Variabel penampung input keypad
int number = 0;         //Variabel penampung nilai angka
int password1 = 1234;
int password2 = 5678;  //Password
int password3 = 2468;
void setup() {
pinMode(2, OUTPUT);//merah
pinMode(15, OUTPUT);//hijau
pinMode(12, OUTPUT);//biru
pinMode(14, OUTPUT);//buzzer
  lcd.init ();              //Mulai LCD
  lcd.setBacklight(HIGH);   //Nyalakan backlight

  gerak1.attach(27);
  gerak2.attach(26);
  gerak3.attach(25);

}

void loop() {
  lcd.setCursor(0,0);
  lcd.print("Input Password");      //Tampilan pada layar LCD
  
  customKey = customKeypad.getKey();    //Baca input keypad

  //------------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 == password1){           //Jika password benar, maka
        lcd.setCursor(0,1);
        lcd.print("Access Accepted ");  //Tampilan LCD
        gerak1.write(180);
        delay(10);
        digitalWrite(2, HIGH);
        delay(2000);
        digitalWrite(2, LOW);
        delay(2000);
        number = 0;
        lcd.clear(); 
       
      }
      else if(number == password2){           //Jika password benar, maka
        lcd.setCursor(0,1);
        lcd.print("Access Accepted ");  //Tampilan LCD
        gerak2.write(180);
        digitalWrite(15, HIGH);
        delay(2000);
        digitalWrite(15, LOW);
        delay(2000);
        number = 0;
        lcd.clear(); 

      }
      else if(number == password3){           //Jika password benar, maka
        lcd.setCursor(0,1);
        lcd.print("Access Accepted ");  //Tampilan LCD
        gerak3.write(180);
        digitalWrite(12, HIGH);
        delay(2000);
        digitalWrite(12, LOW);
        delay(2000);
        number = 0;
        lcd.clear(); 

      }
      else{                             //Jika salah, maka
        lcd.setCursor(0,1);
        lcd.print("Invalid Password");  //Tampilan LCD
               delay(1000);
        number = 0;
        lcd.clear();
        
      }
      
    break;

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

    case'A' :
      gerak1.write(90);
      break;
    case'B' :
      gerak2.write(90);
      break;
    case'C' :
      gerak3.write(90);
      break;
  }
}