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

#define ROW_NUM    4  
#define COLUMN_NUM 4  
#define SERVO_PIN  A0 

Servo servo; 

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 );

const String password_1 = "310376"; 
const String password_2 = "C1202";   
const String password_3 = "0306";    
String input_password;

int angle = 0; 
unsigned long lastTime;

void setup() {
  Serial.begin(9600);
  input_password.reserve(32); 

  servo.attach(SERVO_PIN);
  servo.write(0); 
  lastTime = millis();
}

void loop() {
  char key = keypad.getKey();

  if (key) {
    Serial.println(key);

    if (key == '*') {
      input_password = ""; 
    } else if (key == '#') {
      if (input_password == password_1 || input_password == password_2 || input_password == password_3) {
        Serial.println("Sandi benar, memutar motor servo ke 90 derajat");
        angle = 90;
        servo.write(angle);
        lastTime = millis();
      } else {
        Serial.println("Sandi salah, coba lagi");
      }

      input_password = ""; 
    } else {
      input_password += key; 
    }
  }

  if (angle == 90 && (millis() - lastTime) > 5000) { 
    angle = 0;
    servo.write(angle);
    Serial.println("Memutar motor servo kembali ke 0 derajat");
  }
}