#include <LCD_I2C.h>

LCD_I2C lcd(0x27, 16, 2);

#define SW0 2
#define SW1 3
#define SW2 4
#define SW3 5

#define ADC1 A0
#define ADC2 A1

int menu;

void setup() {
  lcd.begin();
  lcd.backlight();

  pinMode(SW0, INPUT_PULLUP);
  pinMode(SW1, INPUT_PULLUP);
  pinMode(SW2, INPUT_PULLUP);
  pinMode(SW3, INPUT_PULLUP);
}

void loop() {
//   //////////////////MENU 0//////////////////
//   if (menu == 0) {
//     lcd.setCursor(3, 0);
//     lcd.print("Tekan SW0");
//     }
//    if (menu == 1 && digitalRead(SW3) == 0) {
//     lcd.clear();
//     menu = 0;
//     while(digitalRead(SW3) == 0){}
//    }
//    if (menu == 2 && digitalRead(SW3) == 0) {
//     lcd.clear();
//     menu = 0;
//     while(digitalRead(SW3) == 0){}
//    }
//   //////////////////MENU 1//////////////////
//   if (menu == 1) {
//     lcd.setCursor(0, 0);
//     lcd.print(">ADC-A0");
//     lcd.setCursor(0, 1);
//     lcd.print(" ADC-A1");
//     if (digitalRead(SW0) == 0) {
//      menu = 3;
//      }
//     }
//    if (menu == 0 && digitalRead(SW0) == 0) {
//     lcd.clear();
//     menu = 1;
//     while (digitalRead(SW0) == 0) {}
//     }
//    if (digitalRead(SW2) == 0 && menu > 0) {
//     menu = 1;
//     while(digitalRead(SW2) == 0){}
//     }
//    if (menu == 3 && digitalRead(SW3) == 0) {
//     lcd.clear();
//     menu = 1;
//     while(digitalRead(SW3) == 0){}
//     }

//   //////////////////MENU 2//////////////////
//   if (menu == 2) {
//     lcd.setCursor(0, 0);
//     lcd.print(" ADC-A0");
//     lcd.setCursor(0, 1);
//     lcd.print(">ADC-A1");
//     }
//    if (digitalRead(SW1) == 0 && menu > 0) {
//     menu = 2;
//     while(digitalRead(SW1) == 0){}
//     }
//    if (menu == 4 && digitalRead(SW3) == 0) {
//     lcd.clear();
//     menu = 2;
//     while(digitalRead(SW3) == 0){}
//     }

//   //////////////////MENU 3//////////////////
//   if (menu == 3) {
//     lcd.setCursor(0,0);
//     lcd.print("Nilai ADC-A0");
//     lcd.setCursor(0,1);
//     lcd.print(analogRead(ADC1));
//     lcd.print("    ");
//     }
//    if (menu == 1 && digitalRead(SW0) == 0) {
//     lcd.clear();
//     menu = 3;
//     while (digitalRead(SW0) == 0){}
//     }

//   //////////////////MENU 4//////////////////
//   if (menu == 4) {
//     lcd.setCursor(0,0);
//     lcd.print("Nilai ADC-A1");
//     lcd.setCursor(0,1);
//     lcd.print(analogRead(ADC2));
//     lcd.print(" ");
//     }
//    if (menu == 2 && digitalRead(SW0) == 0) {
//     lcd.clear();
//     menu = 4;
//     while (digitalRead(SW0) == 0){}
//   }
// }
  

 if (menu == 0) {
    lcd.setCursor(3, 0);
    lcd.print("Tekan SW0");
    if (digitalRead(SW0) == 0 || digitalRead(SW1) == 0 || 
        digitalRead(SW2) == 0 || digitalRead(SW3) == 0 ){
    lcd.clear();
    menu = 1;
    while(digitalRead(SW0) == 0){}
    while(digitalRead(SW1) == 0){}
    while(digitalRead(SW2) == 0){}
    while(digitalRead(SW3) == 0){}
    }
  }
  if (menu == 1) {
    lcd.setCursor(0, 0);
    lcd.print(">ADC-A0");
    lcd.setCursor(0, 1);
    lcd.print(" ADC-A1");
    if (digitalRead(SW0) == 0) {
     menu = 2;
     while(digitalRead(SW0) == 0){}
    }
  }

  if (menu == 2) {
    lcd.setCursor(0, 0);
    lcd.print(" ADC-A0");
    lcd.setCursor(0, 1);
    lcd.print(">ADC-A1");
    if (digitalRead(SW1) == 0) {
     menu = 3;
     while(digitalRead(SW1) == 0){}
    }
  }
}