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

#define Password_Length 6

Servo myServo;

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

int pos = 0;

char Data[Password_Length];
char Master[Password_Length] = "12345";
byte data_count = 0;
const int pirPin = 10; // Pin sensor PIR, sesuaikan dengan pin yang digunakan

bool door = false;
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] = {0, 1, 2, 3}; // Pin baris keypad
byte colPins[COLS] = {4, 5, 6, 7}; // Pin kolom keypad

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

void setup() {
  myServo.attach(9, 2000, 2400);
  ServoClose();
  lcd.begin(16, 2);
  lcd.print("Pintu Dikunci");
  loading("Loading");
  lcd.clear();
}

void loop() {
  if (door == true) {
    customKey = customKeypad.getKey();
    if (customKey == '#') {
      lcd.clear();
      ServoClose();
      lcd.print("Pintu Tertutup");
      delay(3000);
      door = false;
    }
  } else {
    readPIR();  // Pemanggilan fungsi untuk membaca sensor PIR
    if (door == true) {
      customKey = customKeypad.getKey();
      if (customKey == '#') {
        lcd.clear();
        ServoClose();
        lcd.print("Pintu Tertutup");
        delay(3000);
        door = false;
      }
    } else {
      Open();
    }
  }
}

void loading(char msg[]) {
  lcd.setCursor(0, 1);
  lcd.print(msg);

  for (int i = 0; i < 9; i++) {
    delay(1000);
    lcd.print(".");
  }
}

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

void ServoClose() {
  for (pos = 90; pos >= 0; pos -= 10) {
    myServo.write(pos);
    delay(50); // Tambahkan delay untuk menghindari gerakan servo terlalu cepat
  }
}

void ServoOpen() {
  for (pos = 0; pos <= 90; pos += 10) {
    myServo.write(pos);
    delay(50); // Tambahkan delay untuk menghindari gerakan servo terlalu cepat
  }
}

void Open() {
  lcd.setCursor(0, 0);
  lcd.print("Masukan Sandi");

  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 (strncmp(Data, Master, Password_Length - 1) == 0) {
      lcd.clear();
      ServoOpen();
      lcd.print("Pintu Terbuka");
      door = true;
      delay(5000);
      loading("Menunggu");
      lcd.clear();
      lcd.print("Waktu Habis!");
      delay(1000);
      ServoClose();
      door = false;
    } else {
      lcd.clear();
      lcd.print("Sandi Salah");
      door = false;
      delay(1000);
    }
    lcd.clear();
    clearData();
  }
}

void readPIR() {
  int pirValue = digitalRead(pirPin);

  if (pirValue == HIGH) {
    lcd.clear();
    lcd.print("Deteksi Gerakan!");
    delay(2000); // Tahan pesan deteksi gerakan selama 2 detik (sesuaikan)
    lcd.clear();
  }
}