#include <Keypad.h> //biblioteka od klawiatury

const byte ROWS = 2; // ile wierszy
const byte COLS = 2; //ile kolumn

byte rowPins[ROWS] = {A0, A1,}; //piny wierszy
byte colPins[COLS] = {A3, A4}; //piny kolum

char keys[ROWS][COLS] = {
  {'1','2'},
  {'3','4'},
};

Keypad klawiatura = Keypad( makeKeymap(keys), rowPins, colPins, ROWS, COLS ); //inicjalizacja klawiatury

int pinAlarmuPozycja = 1;
char pinCyfra1 = '1';
char pinCyfra2 = '2';
char pinCyfra3 = '3';
char pinCyfra4 = '4';

char cyfra1;
char cyfra2;
char cyfra3;
char cyfra4;

void setup() {
  pinMode(13, OUTPUT);
  Serial.begin(9600);
  digitalWrite(13, HIGH);
  Serial.println("PODAJ HASLO");


}

void loop() {

    char klawisz = klawiatura.getKey();

   if (klawisz){
    Serial.println(klawisz);
  }

  if (klawisz) {
        //Czy kolejna podana cyfra jest poprawna?
        if (pinAlarmuPozycja == 1){//Jesli sprawdzamy 1 pozycje PINu
          klawisz = cyfra1;
          delay(50);
          pinAlarmuPozycja++; //Cyfra poprawna, mozna sprawdzic na kolejna
        } else if (pinAlarmuPozycja == 2) { //Jesli sprawdzamy 2 pozycje PINu
          klawisz = cyfra2;
          delay(50);
          pinAlarmuPozycja++; //Cyfra poprawna, mozna sprawdzic na kolejna
        } else if (pinAlarmuPozycja == 3) { //Jesli sprawdzamy 3 pozycje PINu
          klawisz = cyfra3;
          delay(50);
          pinAlarmuPozycja++; //Cyfra poprawna, mozna sprawdzic na kolejna
        } else if (pinAlarmuPozycja == 4) { //Jesli sprawdzamy 4 pozycje PINu
          klawisz = cyfra4;
          delay(50);
          pinAlarmuPozycja++;
        }

        if (pinAlarmuPozycja == 5 && pinCyfra1 == cyfra1 && pinCyfra2 == cyfra2 && pinCyfra3 == cyfra3 && pinCyfra4 == cyfra4){
            Serial.println("OTWARTO");
            digitalWrite(13, LOW);
            delay(1000);
            pinAlarmuPozycja++;

        }if (pinAlarmuPozycja == 5){
         if (pinCyfra1 != cyfra1 || pinCyfra2 != cyfra2 || pinCyfra3 != cyfra3 || pinCyfra4 != cyfra4){
              Serial.println("BLEDNY KOD");
              digitalWrite(13,HIGH);
              delay(1000);
              pinAlarmuPozycja = 1;
            }
        }

        }
}