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

#define buzzer 12

Servo servo;
LiquidCrystal_I2C lcd(0x27, 16, 2);

byte a = 5;

Password openPassword = Password("1234");  // Password untuk membuka pintu
Password lockPassword = Password("5678");  // Password untuk mengunci pintu

byte maxPasswordLength = 6;
byte currentPasswordLength = 0;
const byte ROWS = 4; // Four rows
const byte COLS = 4; // Four columns

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

byte rowPins[ROWS] = {2, 3, 4, 5};
byte colPins[COLS] = {6, 7, 8, 9};

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

void setup() {
  Serial.begin(9600);
  pinMode(buzzer, OUTPUT);
  servo.attach(11);
  servo.write(50); // Mengatur posisi awal servo pada posisi terbuka
  lcd.init();
  lcd.backlight();
  lcd.setCursor(3, 0);
  lcd.print("WELCOME TO");
  lcd.setCursor(0, 1);
  lcd.print("DOOR LOCK SYSTEM");
  delay(3000);
  lcd.clear();
}

void loop() {
  lcd.setCursor(1, 0);
  lcd.print("ENTER PASSWORD");

  char key = keypad.getKey();
  if (key != NO_KEY) {
    delay(60);
    if (key == 'C') {
      resetPassword();
    } else if (key == 'D') {  // Tombol "#" sebagai tombol "Enter"
      if (currentPasswordLength > 0) {
        if (openPassword.evaluate()) {
          doorOpen();
        } else if (lockPassword.evaluate()) {
          doorLock();
        } else {
          wrongPassword();
        }
        resetPassword();
      }
    } else {
      processNumberKey(key);
    }
  }
}

void processNumberKey(char key) {
  if (currentPasswordLength < maxPasswordLength) {
    lcd.setCursor(a, 1);
    lcd.print("*");
    a++;
    if (a == 11) {
      a = 5;
    }
    currentPasswordLength++;
    openPassword.append(key);
    lockPassword.append(key);
  }
}

void doorOpen() {
  digitalWrite(buzzer, HIGH);
  delay(300);
  digitalWrite(buzzer, LOW);
  servo.write(50); // Menggerakkan servo untuk membuka pintu
  delay(2000);
  lcd.setCursor(0, 0);
  lcd.print("CORRECT PASSWORD");
  lcd.setCursor(0, 1);
  lcd.print("OPEN THE DOOR...");
  delay(2000);
  lcd.clear();
  a = 5;
}

void doorLock() {
  digitalWrite(buzzer, HIGH);
  delay(300);
  digitalWrite(buzzer, LOW);
  servo.write(110); // Menggerakkan servo untuk mengunci pintu
  delay(2000);
  lcd.setCursor(0, 0);
  lcd.print("CORRECT PASSWORD");
  lcd.setCursor(2, 1);
  lcd.print("DOOR LOCKED");
  delay(2000);
  lcd.clear();
  a = 5;
}

void resetPassword() {
  openPassword.reset();
  lockPassword.reset();
  currentPasswordLength = 0;
  lcd.clear();
  a = 5;
}

void wrongPassword() {
  digitalWrite(buzzer, HIGH);
  delay(200);
  digitalWrite(buzzer, LOW);
  delay(200);
  digitalWrite(buzzer, HIGH);
  delay(200);
  digitalWrite(buzzer, LOW);
  delay(200);
  digitalWrite(buzzer, HIGH);
  delay(200);
  digitalWrite(buzzer, LOW);
  delay(200);
  lcd.setCursor(0, 0);
  lcd.print("WRONG PASSWORD!");
  lcd.setCursor(0, 1);
  lcd.print("PLEASE TRY AGAIN");
  delay(2000);
  lcd.clear();
  a = 5;
}