#include <SPI.h>
#include <Wire.h>
#include <Adafruit_GFX.h>
#include <Adafruit_SSD1306.h>
#include <Keypad.h>
#include <ESP32Servo.h>
const int rows=4;
const int cols=4;
int A = 0;
char keys[rows] [cols]={
{'1','2','3','A'},
{'4','5','6','B'},
{'7','8','9','C'},
{'*','0','#','D'}
};
uint8_t colpins[cols] = {2, 0, 4, 16};
uint8_t rowpins[rows] = {12, 14, 27, 26};
Keypad keypad = Keypad(makeKeymap(keys), rowpins, colpins, rows, cols);

Adafruit_SSD1306 display;
Servo myservo;
const String password = "9999";
String input_password;

void setup() {
  Serial.begin(115200);
  myservo.attach(32);
  display.begin(SSD1306_SWITCHCAPVCC, 0x3c);
  display.setCursor(0,5);
  display.setTextSize(2);
  display.setTextColor(WHITE, BLACK); //กำหนดข้อความสีขาว ฉากหลังสีดำ
  display.clearDisplay();
  input_password.reserve(32);
}

void loop() {
 char key = keypad.getKey();
 if(key){
 Serial.println(key);
 display.print("*");
 display.display();
 input_password += key;
 A=++A;

  if(key == 'D') {
    input_password = "";
    display.display();
    display.clearDisplay();
    display.setCursor(0,5);
    A = 0;
  }
  else if (A == 4){
    if(input_password == password){
     A=++A;
     myservo.write(0);
     delay(3000);
     myservo.write(90);
     Serial.println("X");
     display.clearDisplay();
     display.display();
     display.setCursor(0,5);
     display.print("X");
     display.display();
     display.clearDisplay();
     display.display();
     display.setCursor(0,5);
  }
   else {
        Serial.println("T");
        display.clearDisplay();
        display.display();
        display.setCursor(0,5);
        display.print("T");
        display.display();
        delay(3000);
        display.clearDisplay();
        display.display();
        display.setCursor(0,5); 
   }input_password = "";  
      A = 0; 
    }
}
 }