#include <Wire.h>
#include <Adafruit_GFX.h>
#include <Adafruit_SSD1306.h>
#include <Keypad.h>
#include <ESP32Servo.h> //deklarasi library servo untuk ESP32

#define TINGGI_LAYAR 64 // Tinggi layar OLED yang digunakan
#define LEBAR_LAYAR 128 // Lebar layar OLED yang digunakan

const byte ROWS = 4;    //Jumlah baris keypad
const byte COLS = 4;    //Jumlah kolom keypad

Adafruit_SSD1306 oled(LEBAR_LAYAR, TINGGI_LAYAR, &Wire, -1);
Servo myServo; //deklarasi perintah dasar servo

char Keys[ROWS][COLS] = {   //Membuat array untuk mapping keypad
  {'1','2','3','A'},
  {'4','5','6','B'},
  {'7','8','9','C'},
  {'*','0','#','D'}
};

byte rowPins[ROWS] = { 13, 23, 19, 18 }; //Deklarasi pin R pada keypad
byte colPins[COLS] = { 5, 4, 2, 15 }; //Deklarasi pin C pada keypad  

Keypad customKeypad = Keypad( makeKeymap(Keys), rowPins, colPins, ROWS, COLS);    //Masukkan info keypad pada library


char customKey;         //Variabel penampung input keypad
int number = 0;         //Variabel penampung nilai angka
int password = 1379;    //Password
int buzzer = 14;        //Deklarasi pin buzzer

void setup() {
  Serial.begin(9600);
  myServo.attach(12); //inisialisasi pin servo
  pinMode(buzzer, OUTPUT); //inisialisasi pin buzzer sebagai output

  //Debuging OLED
  if (!oled.begin(SSD1306_SWITCHCAPVCC, 0x3C)) {
    Serial.println(F("failed to start SSD1306 OLED"));
    while (1);
  }
  oled.clearDisplay();
  
  oled.setTextSize(1);         // Atur ukuran text
  oled.setTextColor(WHITE);    // Atur warna text
  oled.setCursor(20, 20);       // Atur posisi text pada display
  oled.println("SELAMAT DATANG"); // Text yang dicetak
  oled.display(); // Perintah untuk membuat OLED menampilkan tulisannya, setiap akhir void jika menggunakan OLED harus ada perintah ini
  delay(2000);
  oled.clearDisplay(); // Menghapus semua karakter yang ada di OLED
}

void loop() {
  oled.setTextSize(1);
  oled.setTextColor(WHITE); 
  oled.setCursor(0,0);
  oled.print("Input Password");      //Tampilan pada layar LCD
  
  customKey = customKeypad.getKey();    //Baca input keypad

  switch(customKey){
    case '0' ... '9':
      oled.setTextSize(1);
      oled.setTextColor(WHITE); 
      oled.setCursor(0,10);
      number = number * 10 + (customKey - '0'); 
      oled.print(number); 
    break;

    case '#':
      if(number == password){          //Jika password benar, maka
        oled.setTextSize(1);
        oled.setTextColor(WHITE); 
        oled.setCursor(0,10);
        oled.print("Access Accepted ");  //Tampilan LCD
        oled.display();
        myServo.write(0); //Perintah memutar servo ke sudut tertentu
        noTone(buzzer); //Perintah mematikan buzzer
        delay(2000);
        oled.clearDisplay();
        number = 0;
      }
      else{                             //Jika salah, maka
        oled.setTextSize(1);
        oled.setTextColor(WHITE); 
        oled.setCursor(0,10);
        oled.print("Invalid Password");  //Tampilan LCD
        oled.display();
        myServo.write(180);
        tone(buzzer, 200); //Perintah menyalakan buzzer dengan frekuensi tertentu
        delay(2000);
        oled.clearDisplay();
        number = 0;
      }
    break;

    case '*':
      number = 0;
      oled.clearDisplay();
    break;

    case 'A':
      myServo.write(180);
      number = 0;
      oled.clearDisplay();
  }
  oled.display();
}