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

#define Password_Length 5
#define I2C_ADDR    0x27
#define LCD_COLUMNS 20
#define LCD_LINES   2


Servo myservo;
LiquidCrystal lcd(A0, A1, A2, A3, A4, A5);
LiquidCrystal_I2C lcd(I2C_ADDR, LCD_COLUMNS, LCD_LINES);

int pos = 0;

char Data[Password_Length];
char Master[Password_Length] = "1234";
byte data_count = 0, master_count = 0;

bool Pass_is_good;
bool door = false;
char customKey;
int attempt = 0;


/*---preparing keypad---*/

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] = {0, 1, 2, 3};
byte colPins[COLS] = {4, 5, 6, 7};

Keypad customKeypad( makeKeymap(keys), rowPins, colPins, ROWS, COLS);


/*--- Main Action ---*/
void setup(){
  myservo.attach(9, 2000, 2400);
  ServoClose();
  lcd.begin(16, 2);
 
}
void loop(){
  if (door == true){
    customKey = customKeypad.getKey();
    if (customKey == '#') {
      lcd.clear();
      ServoClose();
      door = false;
    }
  }
  else
    Open();
}



void clearData(){
  while (data_count != 0){ 
    Data[data_count--] = 0;
  }
  return;
}

void ServoClose(){
  for (pos = 90; pos >= 0; pos -= 10) { 
    myservo.write(pos);
  }
}

void ServoOpen(){
  for (pos = 0; pos <= 90; pos += 10) {
    myservo.write(pos);  
  }
}

void Open(){
  lcd.setCursor(0, 0);
  lcd.print("Enter Password");
  
  customKey = customKeypad.getKey();
  if (customKey){
    Data[data_count] = customKey;
    lcd.setCursor(data_count, 1);
    lcd.print(Data[data_count]);
    data_count++;
  }

  if (data_count == Password_Length - 1){
    if (!strcmp(Data, Master)){
      lcd.clear();
      ServoOpen();
      lcd.print("Unlock Sucessful");
      door = true;
      delay(5000);
   
      ServoClose();
      door = false;      
    }
    else
    {
      lcd.clear();
      lcd.print(" Wrong Password ");
      door = false;
      attempt+=1;
    }
    delay(1000);
    lcd.clear();
    clearData();
  }
  if(attempt == 3){
  	  lcd.clear();
      door = true;
      lcd.print(" 3 attempts done ");
  }
}