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

const uint8_t LEDS = 12;
#include <LiquidCrystal.h>

#define codeLength 5
Servo myservo;
char Code[codeLength];
char PassW[codeLength] = "1234";
byte keycount = 0;

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'}
};

LiquidCrystal lcd(13,12,9,8,7,6);
uint8_t rowPins[ROWS] = { 26, 22, 21, 20 }; 
uint8_t colPins[COLS] = { 19, 18, 17, 16 }; 

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

void setup() 
{
  lcd.begin(16,2);
  lcd.print("Enter a Key:-");
  myservo.attach(28);
}

void loop()
{
  int pos;
  char customKey = customKeypad.getKey();
  if(customKey)
  {
	 Code[keycount] = customKey;
	 Serial.print(Code[keycount]);
     lcd.setCursor(5,1);
     lcd.print(Code[keycount]);
	 keycount++;
    
  }
  if(keycount==codeLength-1)
  {
    Serial.println("");
    if(!strcmp(Code,PassW))
    {
      Serial.println("Correct Password");
      lcd.clear();
      lcd.setCursor(0,1);
      lcd.print("Correct Password");
      for(pos = 90; pos<=180;pos++)
      {
        myservo.write(pos);
        delay(40);
      }
      delay(1000);
      for(pos = 180; pos>=90;pos--)
      {
        myservo.write(pos);
        delay(40);
      }
    }
     else
  {
    Serial.println("Incorrect Password");
    delay(1000);
  }
  deletecount();
  }
}

void deletecount()
{
  while(keycount!=0)
  {
    Code[keycount--]=0;
  }
  return;
}