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

#define ROW_NUM    4  // 
#define COLUMN_NUM 4  // 
#define SERVO_PIN  A0 // // Der Pin, wo der Servo angeschlssen ist.

Servo servo; // servo motor

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}; //Die Pins, wo das Keypad angeschlossen ist.
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 = "2504A"; // Password 1
const String password_2 = "5642B";   // Password 2
const String password_3 = "9765";    // Password 3
String input_password;

int angle = 0; // Winkel des Servo Motors
unsigned long lastTime;

void setup() {
  Serial.begin(9600);
  input_password.reserve(32); // Maximale größe des Passwords = 32

  servo.attach(SERVO_PIN);
  servo.write(0); // Setzt servo motor to 0°
  lastTime = millis();
}

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

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

    if (key == '*') {
      input_password = ""; // resetet das input password
    } else if (key == '#') {
      if (input_password == password_1 || input_password == password_2 || input_password == password_3) {
        Serial.println("The password is correct, rotating Servo Motor to 90°");
        angle = 90;
        servo.write(angle);
        lastTime = millis();
      } else {
        Serial.println("The password is incorrect, try again");
      }

      input_password = ""; // resetet the input password
    } else {
      input_password += key; 
    }
  }

  if (angle == 90 && (millis() - lastTime) > 10000) { // 10 Sekunden bleibt er Offen
    angle = 0;
    servo.write(angle);
    Serial.println("Rotating Servo Motor to 0°");
  }
}