#include <Wire.h>
#include <Adafruit_GFX.h>
#include <Adafruit_SSD1306.h>
#include <Keypad.h>

#include <ESP32Servo.h>

Servo myservo;  

int pos = 0;    
#define merah 14
#define hijau 12
#define TINGGI_LAYAR 64 // Tinggi layar OLED yang digunakan
#define LEBAR_LAYAR 128 // Lebar layar OLED yang digunakan

#define buzzer 14
const byte ROWS = 4;    //Jumlah baris keypad
const byte COLS = 4;    //Jumlah kolom keypad

Adafruit_SSD1306 oled(LEBAR_LAYAR, TINGGI_LAYAR, &Wire, -1);

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

uint8_t colPins[COLS] = { 5, 4, 2, 13 }; // Pins connected to C1, C2, C3, C4
uint8_t rowPins[ROWS] = { 22, 21, 19, 18 }; // Pins connected to R1, R2, R3, R4

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

void setup() {
  Serial.begin(9600);
  myservo.attach(15); 
  // initialize OLED display with I2C address 0x3C
  if (!oled.begin(SSD1306_SWITCHCAPVCC, 0x3C)) {
    Serial.println(F("failed to start SSD1306 OLED"));
    while (1);
  }
  oled.clearDisplay();
  pinMode(merah,OUTPUT);
  pinMode(hijau,OUTPUT);
  oled.setTextSize(1);         // Atur ukuran text
  oled.setTextColor(WHITE);    // Atur warna text
  oled.setCursor(20, 20);       // Atur posisi text pada display
  oled.println("SISTEM LOCKER, SILAHKAN KETIK PASSWORD"); // Text yang dicetak
  delay(2000);
  oled.display(); 
  oled.clearDisplay();
  oled.setTextSize(1);
  oled.setTextColor(WHITE);
  oled.setCursor(0,0);
  oled.print("Input Password");// menampilkan display OLED
  digitalWrite(merah,LOW);
  digitalWrite(hijau,LOW);
  pos = 0;
  myservo.write(pos);            
  delay(100);
}

void loop() {
   
        //Tampilan pada layar LCD
  
  customKey = customKeypad.getKey();    //Baca input keypad

  //------------Prosedur jika input berupa angka------------//
  if (customKey != NO_KEY) {
switch(customKey){ 
    case '0' ... '9':
      oled.setTextSize(1);
      oled.setTextColor(WHITE); 
      oled.setCursor(0,10);
      number = number * 10 + (customKey - '0');
      oled.print(number);
      oled.display();
      oled.clearDisplay(); 
    break;

    //------------Jika input '#' maka cek password------------//
    case '#':
      if(number == password){          //Jika password benar, maka
        oled.setTextSize(1);
        oled.setTextColor(WHITE); 
        oled.setCursor(0,10);
        oled.print("Silahkan masukan barang ");
        pos = 180;
        myservo.write(pos);            
        //delay(100);  
        number = 0;
        digitalWrite(merah,LOW);
        digitalWrite(hijau,HIGH);
        
        oled.display();
        oled.clearDisplay(); 
      } else {                             //Jika salah, maka
        oled.setTextSize(1);
        oled.setTextColor(WHITE); 
        oled.setCursor(0,10);
        oled.print("Password salah"); 

        digitalWrite(merah,HIGH);
        digitalWrite(hijau,LOW);
        
        pos = 0;
        myservo.write(pos);            
        //delay(100);  
        oled.display();
        //delay(2000);
        number = 0;
        oled.clearDisplay();
      }
    break;

    //------------Jika input '*' maka hapus tampilan------------//
    case '*':
      number = 0;
      oled.clearDisplay();
      oled.setTextSize(1);
      oled.setTextColor(WHITE); 
      oled.setCursor(0,10);
      oled.print("Loker terkunci ");
      pos = 0;
      myservo.write(pos);            
      delay(100);
      digitalWrite(merah,LOW);
      digitalWrite(hijau,LOW); 
      
    break;
  }

  }
  
}/* Program Kunci Pintu dengan password input Keypad 4x4 dibuat oleh Indobot */

//komponen : 
// 1. ESP32
// 2. Keypad
// 3. LCD
// 4. Servo
// 5. 2 LED

//ALur:
//Pengguna memasukkan password dan menekan tombol "*"