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

Servo myservo;
LiquidCrystal lcd(A0, A1, A2, A3, A4, A5);

#define Password_Length 5 // Adjusted to match the length of the password + NULL char

int pos = 0;    // variable to store the servo position

char Data[Password_Length]; // 4 chars for password + 1 NULL char = 5

char Master[Password_Length] = "2367";

byte data_count = 0;

bool door = true;

char customKey;

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] = {1, 2, 3, 4}; //connect to the row pinouts of the keypad
byte colPins[COLS] = {5, 6, 7, 8}; //connect to the column pinouts of the keypad

Keypad customKeypad(makeKeymap(keys), rowPins, colPins, ROWS, COLS); //initialize an instance of class NewKeypad

void setup() {
  myservo.attach(9);
  ServoClose();
  lcd.begin(16, 2);
  lcd.print(" Arduino Door");
  lcd.setCursor(0, 1);
  lcd.print("--Look project--");
  delay(3000);
  lcd.clear();
}

void loop() {
  if (!door) {
    customKey = customKeypad.getKey();
    if (customKey == '#') {
      lcd.clear();
      ServoClose();
      lcd.print("  Door is close");
      delay(3000);
      door = true;
    }
  } else {
    Open();
  }
}

void clearData() {
  while (data_count != 0) {
    Data[data_count--] = 0; // clear array for new data
  }
  return;
}

void ServoOpen() {
  for (pos = 0; pos <= 180; pos += 5) { // goes from 0 degrees to 180 degrees
    myservo.write(pos); // tell servo to go to position in variable 'pos'
    delay(15); // waits 15ms for the servo to reach the position
  }
}

void ServoClose() {
  for (pos = 180; pos >= 0; pos -= 5) { // goes from 180 degrees to 0 degrees
    myservo.write(pos); // tell servo to go to position in variable 'pos'
    delay(15); // waits 15ms for the servo to reach the position
  }
}

void Open() {
  lcd.setCursor(0, 0);
  lcd.print(" Enter Password");
  customKey = customKeypad.getKey();

  if (customKey) { // makes sure a key is actually pressed
    Data[data_count] = customKey; // store char into data array
    lcd.setCursor(data_count, 1); // move cursor to show each new char
    lcd.print(Data[data_count]); // print char at said cursor
    data_count++; // increment data array by 1 to store new char
  }

  if (data_count == Password_Length - 1) { // if the array index is equal to the number of expected chars, compare data to master
    if (!strcmp(Data, Master)) { // equal to (strcmp(Data, Master) == 0)
      lcd.clear();
      ServoOpen();
      lcd.print("  Door is Open");
      door = false;
    } else {
      lcd.clear();
      lcd.print("  Wrong Password");
      delay(1000);
      door = true;
    }
    clearData();
  }
}