#include <ezButton.h>

ezButton button1(22);
ezButton button2(24);

bool MainMenuEn = false;
bool SubMenuEn = false;
int8_t MainMenuCnt = 1;
int8_t MainMenuItems = 5-1;
char *MainMenuStr[] = {"Pulses per unit","Limit up","Limit down","Anti dive","PID - P"};


void setup() {
  Serial.begin(9600);
  button1.setDebounceTime(50); // set debounce time to 50 milliseconds
  button2.setDebounceTime(50); // set debounce time to 50 milliseconds
}

void loop() {
  button1.loop(); // MUST call the loop() function first
  button2.loop(); // MUST call the loop() function first

  int btn1State = button1.getState();
  int btn2State = button2.getState();
  //Serial.print("button 1 state: ");
  //Serial.println(btn1State);



  if(button1.isPressed()){
    Serial.println(MainMenuStr[MainMenuCnt]);
    MainMenuCnt++;
    if (MainMenuCnt > MainMenuItems){
      MainMenuCnt = 0;
    }
  }
  if(button2.isPressed()){
    Serial.println(MainMenuStr[MainMenuCnt]);
    MainMenuCnt--;
    if (MainMenuCnt < 0){
      MainMenuCnt = MainMenuItems;
    }
  }
}