#include <Keypad.h>
#include <Wire.h>
#include <LiquidCrystal_I2C.h>

// Inicializácia LCD displeja
LiquidCrystal_I2C lcd(0x27, 16, 2); // adresa LCD pre 16 znakov a 2 riadky

String pad;
const byte numRows = 4;
const byte numCols = 4;
String password = "4321";
char keypressed;
bool changeMode = false; // Režim na zmenu hesla
String newPassword;      // Dočasný reťazec pre nové heslo

char keymap[numRows][numCols] =
{
  {'1', '2', '3', 'A'},
  {'4', '5', '6', 'B'},
  {'7', '8', '9', 'C'},
  {'*', '0', '#', 'D'}
};

// Priradenie pinov pre riadky a stĺpce klávesnice
byte rowPins[numRows] = {23, 19, 18, 5}; // Zmenené na vhodné piny pre ESP32
byte colPins[numCols] = {4, 16, 17, 15}; // Zmenené na vhodné piny pre ESP32

Keypad myKeypad = Keypad(makeKeymap(keymap), rowPins, colPins, numRows, numCols); // mapping keypad

void setup() {
  // Inicializácia LCD
  lcd.init();
  lcd.backlight();
  lcd.setCursor(0, 0);
  lcd.print("Keypad");
  lcd.setCursor(0, 1);
  lcd.print("Test");
  delay(1000);
  lcd.clear();
}

void loop() {
  readKeypad();

  if (keypressed == '#') { // Overenie hesla
    if (changeMode) {
      // Režim zmeny hesla - potvrdenie nového hesla
      password = pad; // Nastaviť nové heslo
      lcd.setCursor(0, 1);
      lcd.print("Password Changed");
      changeMode = false; // Ukončiť režim zmeny hesla
      delay(2000);
    } else {
      // Overenie pôvodného hesla
      if (pad == password) {
        lcd.setCursor(0, 1);
        lcd.print("Access Granted");
      } else {
        lcd.setCursor(0, 1);
        lcd.print("Access Denied");
      }
      delay(2000);
    }
    pad = ""; // Resetovanie vstupu
    lcd.clear();
  }

  if (keypressed == '*') { // Resetovanie zadávania
    pad = "";
    lcd.clear();
  }

  if (keypressed == 'C') { // Aktivácia režimu zmeny hesla
    if (pad == password) { // Skontrolovať správne heslo pred zmenou
      lcd.setCursor(0, 1);
      lcd.print("Enter New Pass:");
      changeMode = true; // Aktivovať režim zmeny hesla
      pad = ""; // Resetovať vstup pre nové heslo
      delay(1000);
      lcd.clear();
    } else {
      lcd.setCursor(0, 1);
      lcd.print("Invalid Password");
      delay(2000);
      lcd.clear();
      pad = ""; // Resetovať vstup
    }
  }

  if (keypressed == 'D' && pad.length() > 0) { // Mazanie posledného znaku
    pad.remove(pad.length() - 1); // Odstrániť posledný znak
    lcd.clear();
  }

  // Vypísať aktuálne zadané heslo
  lcd.setCursor(0, 0);
  lcd.print(pad);
  delay(100);
}

void readKeypad() {
  keypressed = myKeypad.getKey(); // Detekcia stlačenia klávesnice
  if (keypressed != '#' && keypressed != '*' && keypressed != 'C' && keypressed != 'D' && keypressed != '\0') { // Skontrolovať, či nie je špeciálny kláves
    pad += keypressed; // Pridať kláves do reťazca
  }
}