#include <Wire.h>
#include <LiquidCrystal_I2C.h>
#include <Servo.h>
#include <Keypad.h>

Servo servo1;
Servo servo2;

LiquidCrystal_I2C lcd(0x27, 16, 2); // Alamat LCD I2C dan ukuran (sesuaikan)
const int buzzerPin = 9; // Pin untuk buzzer

const byte ROWS = 4; // Jumlah baris keypad
const byte COLS = 4; // Jumlah kolom keypad
char keys[ROWS][COLS] = {
  {'1', '2', '3', 'A'},
  {'4', '5', '6', 'B'},
  {'7', '8', '9', 'C'},
  {'*', '0', '#', 'D'}
};
byte rowPins[ROWS] = {5, 4, 3, 2}; // Ke pin baris keypad
byte colPins[COLS] = {13, 12, 11, 10}; // Ke pin kolom keypad
Keypad keypad = Keypad( makeKeymap(keys), rowPins, colPins, ROWS, COLS );

const int IRProximity1 = 6; // Pin untuk Sensor IR Proximity 1
const int IRProximity2 = 7; // Pin untuk Sensor IR Proximity 2

int halanganCount1 = 0;
bool accessGranted = false;
unsigned long accessTimer = 0;

void setup() {
  servo1.attach(8); // Servo 1 dihubungkan ke pin 8
  servo2.attach(9); // Servo 2 dihubungkan ke pin 9
  
  pinMode(IRProximity1, INPUT);
  pinMode(IRProximity2, INPUT);
  
  lcd.init();
  lcd.backlight();
  lcd.setCursor(0, 0);
  lcd.print("Selamat Datang");
  delay(2000);
  lcd.clear();
  lcd.setCursor(0, 0);
  lcd.print("Masukkan Coin");
}

void loop() {
  char key = keypad.getKey();
  int irValue1 = digitalRead(IRProximity1);
  int irValue2 = digitalRead(IRProximity2);
  
  if (!accessGranted) {
    // Akses program belum diberikan
    if (irValue1 == LOW) {
      // Jika Sensor IR Proximity 1 terhalang
      halanganCount1++;
      if (halanganCount1 == 1) {
        lcd.clear();
        lcd.print("Masukkan 2 Coin");
      } else if (halanganCount1 == 2) {
        lcd.clear();
        lcd.print("Masukkan 1 Coin");
      } else if (halanganCount1 == 3) {
        lcd.clear();
        lcd.print("OK, Terimakasih.");
        accessGranted = true;
        accessTimer = millis() + 20000; // Countdown 20 detik
      }
      delay(1000);
    }
  } else {
    // Akses program diberikan
    if (millis() < accessTimer) {
      // Countdown masih berjalan
      lcd.clear();
      lcd.print("Countdown: " + String((accessTimer - millis()) / 1000) + " detik");
    } else {
      // Countdown selesai
      lcd.clear();
      if (irValue2 == LOW) {
        // Jika Sensor IR Proximity 2 terhalang
        if (key == '1') {
          lcd.print("Proses Program");
          servo1.write(120); // Gerakan servo1
          delay(1000);
          servo1.write(0); // Kembali ke posisi awal
          delay(800);
          servo2.write(0); // Gerakan servo2
          delay(1000);
          lcd.clear();
          lcd.print("Silahkan ambil");
          delay(2000);
          servo2.write(90); // Kembali ke posisi awal
        } else {
          lcd.clear();
          lcd.print("Maaf, barang habis");
          delay(2000);
          servo2.write(180); // Gerakan servo2
          delay(2000);
          servo2.write(90); // Kembali ke posisi awal
        }
        accessGranted = false;
        halanganCount1 = 0;
        lcd.clear();
        lcd.print("Masukkan Coin");
      } else {
        // Sensor IR Proximity 2 tidak terhalang
        lcd.print("Maaf, barang habis");
        delay(2000);
        servo2.write(180); // Gerakan servo2
        delay(2000);
        servo2.write(90); // Kembali ke posisi awal
        accessGranted = false;
        halanganCount1 = 0;
        lcd.clear();
        lcd.print("Masukkan Coin");
      }
    }
  }
}