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

#define SERVO_PIN 9
#define BUZZER_PIN 8

Servo servo;

#define ROW_NUM 4 // empat baris
#define COLUMN_NUM 4 // empat kolom

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

byte pin_rows[ROW_NUM] = {9, 8, 7, 6}; 
byte pin_column[COLUMN_NUM] = {5, 4, 3, 2}; 


Keypad keypad = Keypad( makeKeymap(keys), pin_rows, pin_column, ROW_NUM, COLUMN_NUM );
#define LCD_ADDR 0x27
LiquidCrystal_I2C lcd(LCD_ADDR, 16, 2);
const String password = "1234";
String input_password;
int angle = 0; // the current angle of servo motor
unsigned long lastTime;

void setup() {
  servo.attach(SERVO_PIN);
  pinMode(BUZZER_PIN, OUTPUT);
  lcd.init();
  servo.write(0); // motor servo pada sudut 0 derajat
  digitalWrite(BUZZER_PIN, LOW); // buzzer mati
  lcd.backlight(); // lcd nyala
  lcd.clear(); // lcd bersih
  lcd.print("Masukkan password"); 
}

void loop() {
  // Membaca input dari keypad
  char key = keypad.getKey();

  // Jika ada input
  if (key) {
    // Jika input adalah '*'
    if (key == '*') {
      // Reset input password
      input_password = "";
      // Bersihkan layar lcd
      lcd.clear();
      // Tampilkan teks "Masukkan password"
      lcd.print("Masukkan password");
    }
    // Jika input adalah '#'
    else if (key == '#') {
      // Cek apakah input password sama dengan password yang diinginkan
      if (input_password == password) {
        // Jika sama, putar motor servo ke sudut 90 derajat
        angle = 90;
        servo.write(angle);
        // Nyalakan buzzer selama 1 detik
        digitalWrite(BUZZER_PIN, HIGH);
        delay(1000);
        digitalWrite(BUZZER_PIN, LOW);
        // Bersihkan layar lcd
        lcd.clear();
        // Tampilkan teks "Password benar"
        lcd.print("Password benar");
      }
      else {
        // Jika tidak sama, putar motor servo ke sudut 0 derajat
        angle = 0;
        servo.write(angle);
        // Nyalakan buzzer selama 0,5 detik sebanyak 3 kali
        for (int i = 0; i < 3; i++) {
          digitalWrite(BUZZER_PIN, HIGH);
          delay(500);
          digitalWrite(BUZZER_PIN, LOW);
          delay(500);
        }
        // Bersihkan layar lcd
        lcd.clear();
        // Tampilkan teks "Password salah"
        lcd.print("Password salah");
      }
      // Reset input password
      input_password = "";
    }
    // Jika input adalah karakter lain
    else {
      // Tambahkan input ke input password
      input_password += key;
      // Tampilkan input password pada lcd
      lcd.clear();
      lcd.print(input_password);
    }
  }
  if (angle == 90 && (millis() - lastTime) > 5000) { // 5 seconds
    // Putar motor servo ke sudut 0 derajat
    angle = 0;
    servo.write(angle);
    // Bersihkan layar lcd
    lcd.clear();
    // Tampilkan teks "Masukkan password"
    lcd.print("Masukkan password");
  }
}