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


LiquidCrystal_I2C lcd(0x27, 20, 4);

String msg1 = "Intra!";
String msg2 = "Cheie invalida!";
String code;
String enter_key = "5832#"; // 5832# - key

int counter = 0;
Servo myservo;

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

uint8_t colPins[COLS] = { 5, 4, 3, 2 }; // Pins connected to C1, C2, C3, C4
uint8_t rowPins[ROWS] = { 9, 8, 7, 6 }; // Pins connected to R1, R2, R3, R4

Keypad keypad = Keypad(makeKeymap(keys), rowPins, colPins, ROWS, COLS);

void setup() {
  Serial.begin(9600);
  lcd.init();
  lcd.backlight();
  lcd.setCursor(3, 0);
  lcd.print("Enter key:");
  myservo.attach(10);
}

void loop() {
  char key = keypad.getKey();
  
  if (key != NO_KEY) {
    
    code += key;
    counter++;
    Serial.print(key);
    myservo.write(90); 


    if(enter_key == code && counter == 5){
      lcd.setCursor(6, 1);
      lcd.print(code);
      delay(1000);
      lcd.clear();
      lcd.setCursor(5, 0);
      lcd.print(msg1);
      delay(2000);
      myservo.write(0);
      delay(4000);
      myservo.write(90);  
      lcd.clear();
      lcd.setCursor(3, 0);
      lcd.print("Enter key:");
      counter = 0;
      code = "";
    }
    
    if(enter_key != code && counter == 5){
      lcd.clear();
      lcd.setCursor(1, 0);
      lcd.print(msg2);
      delay(2000);
      lcd.clear();
      lcd.setCursor(3, 0);
      lcd.print("Enter key:");
      counter = 0;
      code = "";
    }

  }
}