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

LiquidCrystal_I2C lcd(0x27, 16, 2);

int upButton = 2;
int downButton = 3;
int selectButton = 4;
int backButton = 5;
int analogPin = A3;
int val = 0;
int menu = 1;
int stop = 0;



void setup() {
  lcd.init();
  lcd.backlight();
  lcd.setCursor(3,0);
  lcd.print(" Pressure ");
  lcd.setCursor(3,1);
  lcd.print("Controller");
  delay(1500);
  pinMode(upButton, INPUT_PULLUP);
  pinMode(downButton, INPUT_PULLUP);
  pinMode(selectButton, INPUT_PULLUP);
  pinMode(backButton, INPUT_PULLUP);
  updateMenu();
}

void loop() {
  //val = analogRead(analogPin); 
  //Serial.println(val);
  if (!digitalRead(downButton)){
    menu++;
    updateMenu();
    delay(100);
    while (!digitalRead(downButton));
  }
  if (!digitalRead(upButton)){
    menu--;
    updateMenu();
    delay(100);
    while(!digitalRead(upButton));
  }
  if (!digitalRead(selectButton)){
    executeAction();
    //updateMenu();
    delay(100);
    while (!digitalRead(selectButton));
  }
  if (!digitalRead(backButton)){
    if (stop==1) {
      lcd.clear();
      lcd.setCursor(4,0);
      lcd.print("Test");
      lcd.setCursor(3,1);
      lcd.print("Stopped");
      stop=0;
    }
    else
    {
      updateMenu();
    }
    delay(100);
    while (!digitalRead(backButton));
  }

}

void updateMenu() {
  switch (menu) {
    case 0:
      menu = 1;
      break;
    case 1:
      lcd.clear();
      lcd.print("->25 mBar Test");
      lcd.setCursor(0, 1);
      lcd.print("  50 mBar Test");
      break;
    case 2:
      lcd.clear();
      lcd.print("  25 mBar Test");
      lcd.setCursor(0, 1);
      lcd.print("->50 mBar Test");
      break;
    case 3:
      lcd.clear();
      lcd.print("->100 mBar Test");
      lcd.setCursor(0, 1);
      lcd.print("  Burst Test");
      break;
    case 4:
      lcd.clear();
      lcd.print("  100 mBar Test");
      lcd.setCursor(0, 1);
      lcd.print("->Burst Test");
      break;
    case 5:
      menu = 4;
      break;
  }
}

void executeAction() {
  switch (menu) {
    case 1:
      action1();
      break;
    case 2:
      action2();
      break;
    case 3:
      action3();
      break;
    case 4:
      action4();
      break;
  }
}

void action1() {
  lcd.clear();
  lcd.print("25mBar Test Run");
    // read the input pin
            // debug value
  lcd.setCursor(1,1);
  lcd.print("P:");
  lcd.print(val);
  stop=1;
  
}
void action2() {
  lcd.clear();
  lcd.print("Executing #2");
  stop=1;
 
}
void action3() {
  lcd.clear();
  lcd.print("Executing #3");
  stop=1; 
}
void action4() {
  lcd.clear();
  lcd.print("Executing #4");
  stop=1;
}