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

#define warn 27

const uint8_t ROWS = 4;
const uint8_t COLS = 4;


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

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

Keypad customKeypad = Keypad( makeKeymap(Keys), rowPins, colPins, ROWS, COLS);

Servo servoku1,servoku2,servoku3,servoku4,servoku5;
LiquidCrystal_I2C LCD = LiquidCrystal_I2C(0x27, 16, 2);

char customKey;        
int number = 0;       
int password1 = 2001;   
int password2 = 4752;    
int password3 = 22671;  
int password4 = 3500;    
int password5 = 1120;   

void setup(){
  servoku1.attach(23);
  servoku2.attach(13);
  servoku3.attach(32);
  servoku4.attach(25);
  servoku5.attach(33);

  servoku1.write(90); 
  servoku2.write(90);
  servoku3.write(90); 
  servoku4.write(90); 
  servoku5.write(90); 

  // Posisi Tutup (90)
  // posisi buka (180)

  pinMode(warn, OUTPUT);
  digitalWrite(warn, LOW);

  LCD.init();
  LCD.backlight();
  LCD.setCursor(4, 0);
  LCD.print("SILENTO");
  LCD.setCursor(4, 1);
  LCD.print("LIBRARY");
  delay(3000);
  LCD.clear();
}

void loop(){
  LCD.setCursor(0, 0);
  LCD.print("INPUT PASSWORD");
  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, 0);
        LCD.print("PASSWORD VALID"); 
        LCD.setCursor(0, 1);
        LCD.print("LOCKER 1 OPENED");
        delay(1000);
        LCD.clear();
        LCD.setCursor(0,0);
        LCD.print("Insert Your");
        LCD.setCursor(0,1);
        LCD.print("Stuff");
        delay(100);
        
        servoku1.write(180);
        delay(3000);
        servoku1.write(90);
      }
      else if(number == password2){
        LCD.setCursor(0, 0);
        LCD.print("PASSWORD VALID"); 
        LCD.setCursor(0,1);
        LCD.print("LOCKER 2 OPENED");
        delay(1000);
        LCD.clear();
        LCD.setCursor(0,0);
        LCD.print("Insert Your");
        LCD.setCursor(0,1);
        LCD.print("Stuff");
        delay(100);
        
        servoku2.write(180);
        delay(3000);
        servoku2.write(90);
      }
      else if(number == password3){
        LCD.setCursor(0, 0);
        LCD.print("PASSWORD VALID");  
        LCD.setCursor(0,1);
        LCD.print("LOCKER 3 OPENED");
        delay(1000);
        LCD.clear();
        LCD.setCursor(0,0);
        LCD.print("Insert Your");
        LCD.setCursor(0,1);
        LCD.print("Stuff");
        delay(100);
        
        servoku3.write(180);
        delay(3000);
        servoku3.write(90);
      }
      else if(number == password4){
        LCD.setCursor(0, 0);
        LCD.print("PASSWORD VALID"); 
        LCD.setCursor(0,1);
        LCD.print("LOCKER 4 OPENED");
        delay(1000);
        LCD.clear();
        LCD.setCursor(0,0);
        LCD.print("Insert Your");
        LCD.setCursor(0,1);
        LCD.print("Stuff");
        delay(100);
        
        servoku4.write(180);
        delay(3000);
        servoku4.write(90);
      }
      else if(number == password5){
        LCD.setCursor(0, 0);
        LCD.print("PASSWORD VALID");  
        LCD.setCursor(0,1);
        LCD.print("LOCKER 5 OPENED");
        delay(1000);
        LCD.clear();
        LCD.setCursor(0,0);
        LCD.print("Insert Your");
        LCD.setCursor(0,1);
        LCD.print("Stuff");
        delay(100);
        
        servoku5.write(180);
        delay(3000);
        servoku5.write(90);
      }
      else{                             
        LCD.setCursor(0,1);
        LCD.print("PASSWORD INVALID");  
        delay(200);
        digitalWrite(warn, HIGH);
        delay(200);
        digitalWrite(warn, LOW);
        delay(200);
        digitalWrite(warn, HIGH);
        delay(200);
        digitalWrite(warn, LOW);
        delay(200);
        digitalWrite(warn, HIGH);
        delay(200);
        digitalWrite(warn, LOW);
        delay(200);
        digitalWrite(warn, HIGH);
      }
      delay(2000);
      number = 0;
      LCD.clear(); 

    break;

    case '*':
      digitalWrite(warn, LOW);
      number = 0;
      LCD.clear();
    break;
  }
}