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

#define Password_Length 5

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

int pos = 0;
int redLEDPin = 13;
int greenLEDPin = 12;

char Data[Password_Length];
char Master[Password_Length] = "2504";
byte data_count = 0;

bool door = false;
char customKey;

// Bezeichnung des Keypads
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};
byte colPins[COLS] = {4, 5, 6, 7};

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

void setup() {
  myservo.attach(9, 2000, 2400);
  ServoClose();
  lcd.begin(16, 2);
  lcd.print("A,L,C,T");
  loading("Projekt 1");
  lcd.clear();

  pinMode(redLEDPin, OUTPUT);
  pinMode(greenLEDPin, OUTPUT);
  digitalWrite(redLEDPin, LOW);
  digitalWrite(greenLEDPin, LOW);
}

void loop() {
  customKey = customKeypad.getKey();
  if (customKey == '#') {
    lcd.clear();
    ServoClose();
    lcd.print("Safe Zu");
    digitalWrite(greenLEDPin, LOW); // Ausmachen des grünen LED
    digitalWrite(redLEDPin, LOW); // Ausmachen des roten LED
    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);
  }
}

void ServoOpen() {
  for (pos = 0; pos <= 90; pos += 10) {
    myservo.write(pos);  
  }
}

void Open() {
  lcd.setCursor(0, 0);
  lcd.print("Zauberwort?");
  
  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 (!strcmp(Data, Master)) {
      lcd.clear();
      ServoOpen();
      lcd.print(" Korrektt:)");
      digitalWrite(greenLEDPin, HIGH); // Angehen des grünen LED
      digitalWrite(redLEDPin, LOW); // Angehen des roten LED
      door = true;
      delay(5000);
      loading("Warten");
      lcd.clear();
      lcd.print(" Zeit Abgelaufen ");
      delay(1000);
      ServoClose();
      door = false;
      digitalWrite(greenLEDPin, LOW); // Ausschalten des grünen LED
    } else {
      lcd.clear();
      lcd.print(" Falsch,Dulli ");
      digitalWrite(redLEDPin, HIGH); // Angehen des roten LED
      digitalWrite(greenLEDPin, LOW); // Ausgehen des grünen LED
      door = false;
      delay(1000);
      digitalWrite(redLEDPin, LOW); // Ausgehen des roten LED
    }
    delay(1000);
    lcd.clear();
    clearData();
  }
}