#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;

enum ProgramState { ACCESS, PROCESS }; // Definisikan dua keadaan program
ProgramState programState = ACCESS; // Keadaan awal adalah ACCESS

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 (programState == ACCESS) {
    // Keadaan ACCESS (Case 1)
    if (irValue1 == LOW) {
      // Sensor IR Proximity 1 terhalang
      if (halanganCount1 == 0) {
        lcd.setCursor(0, 1);
        lcd.print("Masukkan 2 Coin");
        delay(2000);
      } else if (halanganCount1 == 1) {
        lcd.setCursor(0, 1);
        lcd.print("Masukkan 1 Coin ");
        delay(2000);
      }
      halanganCount1++;
    }
    
    if (halanganCount1 == 3) {
      // Jika jumlah halangan = 3, lanjut ke Proses Program (Case 2)
      lcd.clear();
      lcd.setCursor(0, 0);
      lcd.print("Silahkan Pilih 1-2");
      programState = PROCESS;
    } else if (millis() >= 20000) {
      // Jika waktu habis, kembali ke awal
      lcd.clear();
      lcd.setCursor(0, 0);
      lcd.print("Waktu Habis");
      delay(2000);
      halanganCount1 = 0;
      lcd.clear();
      lcd.setCursor(0, 0);
      lcd.print("Masukkan Coin");
    }
  } else if (programState == PROCESS) {
    // Keadaan PROCESS (Case 2)
    if (key == '1') {
      if (irValue2 == LOW) {
        // Jika tombol '1' pada keypad ditekan dan Sensor IR Proximity 2 terhalang
        servo1.write(120);
        delay(1000);
        servo1.write(0);
        lcd.clear();
        lcd.setCursor(0, 0);
        lcd.print("Silahkan ambil");
        servo2.write(0);
        delay(2000);
      } else {
        lcd.clear();
        lcd.setCursor(0, 0);
        lcd.print("Maaf, barang habis");
        servo2.write(180);
        delay(2000);
        servo2.write(90);
        servo1.write(0);
        tone(buzzerPin, 1000, 2000); // Buzzer aktif selama 2 detik
        delay(2000);
        programState = ACCESS;
        lcd.clear();
        lcd.setCursor(0, 0);
        lcd.print("Masukkan Coin");
        halanganCount1 = 0;
      }
    }
  }
}