#include <Keypad.h>
#include <ESP32Servo.h>
#define ROW_NUM    4
#define COLUMN_NUM 4

const int servoPin = 33;

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]      = {21, 19, 18, 5};
byte pin_column[COLUMN_NUM] = {17, 16, 4, 2};

Keypad keypad = Keypad(makeKeymap(keys), pin_rows, pin_column, ROW_NUM, COLUMN_NUM);
Servo myServo;

const String password = "1234";
String input_password;
int pos = 0;

void setup() {
  // put your setup code here, to run once:
  Serial.begin(115200);
  myServo.attach(servoPin, 500, 2400);
  input_password.reserve(32);
}

void loop() {
  char key = keypad.getKey();
  if(key){
    Serial.println(key);
    if (key == '*'){
      input_password = "";
    }else if (key == '#'){
      if(password == input_password){
        Serial.println("Senha correta - ACESSO PERMITIDO.");
        
        for(pos = 0; pos <= 180; pos+= 1){
          myServo.write(pos);
          delay(10);
        }
        for(pos = 180; pos >= 0; pos-= 1){
          myServo.write(pos);
          delay(10);
        } 
      }else{
        Serial.println("Senha incorreta - ACESSO BLOQUEADO.");
      }
      input_password = "";
    }else{
      input_password += key;
    }
  }
  // put your main code here, to run repeatedly:
}