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

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] = {13, 12, 14, 27};
byte colPins[COLS] = {26, 25, 33, 32};

Keypad keypad = Keypad( makeKeymap(keys), rowPins, colPins, ROWS, COLS );

char customKey;
int number = 0;
int password = 1234;

LiquidCrystal_I2C lcd(0x27, 16, 2);

int i = 0;

Servo servoku;
int kunci = 0;
int buka = 90;

void setup(){
  lcd.init();
  lcd.backlight();

  number = 0;
  i = 0;

  servoku.attach(15);
  servoku.write(kunci);

  lcd.setCursor(0,0);
  lcd.print("Input Password");
}

void loop() 
{
  customKey = keypad.getKey();

  switch(customKey){
    case '0' ... '9':
      lcd.setCursor(i,1);
      number = number * 10 + (customKey - '0');
      lcd.print("*");
      i++;
    break;

    // tombol # untuk enter
    case '#':
      if(number == password){ 
        lcd.clear();
        lcd.setCursor(0,0);
        lcd.print("Password Benar");
        lcd.setCursor(0,1);
        lcd.print("Terbuka");
        servoku.write(buka);
        delay(2000);
        lcd.clear();
        lcd.setCursor(0,0);
        lcd.print("Jangan Lupa");
        lcd.setCursor(0,1);
        lcd.print("Dikunci Kembali");
      }
      else{  
        lcd.clear();
        number = 0;
        i = 0;
        lcd.setCursor(0,0);
        lcd.print("Password Salah");
        lcd.setCursor(0,1);
        lcd.print("Ingat-ingat Lagi");
        delay(2000);
        number = 0;
        i = 0;
        setup();
      }
    break;

    // tombol * digunakan untuk mengunci kembali
    case '*':
      servoku.write(kunci);
      lcd.clear();
      lcd.setCursor(0, 0);
      lcd.print("Terkunci Kembali");
      lcd.setCursor(0, 1);
      lcd.print("Terima Kasih");
      delay(2000);
      lcd.clear();
      setup();
    break;
  }
}