#include <LiquidCrystal.h>
#include <Wire.h>
#include "setup.h"

// You can have up to 10 menu items in the menuItems[] array below without having to change the base programming at all. Name them however you'd like. Beyond 10 items, you will have to add additional "cases" in the switch/case
// section of the operateMainMenu() function below. You will also have to add additional void functions (i.e. menuItem11, menuItem12, etc.) to the program.
String menuItems[] = {"ITEM 1", "ITEM 2", "ITEM 3", "ITEM 4", "ITEM 5", "ITEM 6","ITEM 7","ITEM 8","ITEM 9","ITEM I"};
int maxMenuPages = round((sizeof(menuItems) / sizeof(String) / 1.3) + .5);


// Setting the LCD shields pins
LiquidCrystal lcd(7, 6, 5, 4, 3, 12); // initialize the library with the numbers

void setup() {
  Serial.begin(9600);
  lcd.begin(16, 2);
  lcd.clear();

  // Creates the byte for the 3 custom characters
  lcd.createChar(0, menuCursor);
  lcd.createChar(1, upArrow);
  lcd.createChar(2, downArrow);
}

void loop() {
  mainMenuDraw();
  drawCursor();
  operateMainMenu();
}

// This function will generate the 2 menu items that can fit on the screen. They will change as you scroll through your menu. Up and down arrows will indicate your current menu position.
void mainMenuDraw() {
  Serial.print(menuPage);
  lcd.clear();
  lcd.setCursor(1, 0);
  lcd.print(menuItems[menuPage]);
  lcd.setCursor(1, 1);
  lcd.print(menuItems[menuPage + 1]);
  if (menuPage == 0) {
    lcd.setCursor(15, 1);
    lcd.write(byte(2));
  } else if (menuPage > 0 and menuPage < maxMenuPages) {
    lcd.setCursor(15, 1);
    lcd.write(byte(2));
    lcd.setCursor(15, 0);
    lcd.write(byte(1));
  } else if (menuPage == maxMenuPages) {
    lcd.setCursor(15, 0);
    lcd.write(byte(1));
  }
}

// When called, this function will erase the current cursor and redraw it based on the cursorPosition and menuPage variables.
void drawCursor() {
  for (int x = 0; x < 2; x++) {     // Erases current cursor
    lcd.setCursor(0, x);
    lcd.print(" ");
  }

  // The menu is set up to be progressive (menuPage 0 = Item 1 & Item 2, menuPage 1 = Item 2 & Item 3, menuPage 2 = Item 3 & Item 4), so
  // in order to determine where the cursor should be you need to see if you are at an odd or even menu page and an odd or even cursor position.
  if (menuPage % 2 == 0) {
    if (cursorPosition % 2 == 0) {  // If the menu page is even and the cursor position is even that means the cursor should be on line 1
      lcd.setCursor(0, 0);
      lcd.write(byte(0));
    }
    if (cursorPosition % 2 != 0) {  // If the menu page is even and the cursor position is odd that means the cursor should be on line 2
      lcd.setCursor(0, 1);
      lcd.write(byte(0));
    }
  }
  if (menuPage % 2 != 0) {
    if (cursorPosition % 2 == 0) {  // If the menu page is odd and the cursor position is even that means the cursor should be on line 2
      lcd.setCursor(0, 1);
      lcd.write(byte(0));
    }
    if (cursorPosition % 2 != 0) {  // If the menu page is odd and the cursor position is odd that means the cursor should be on line 1
      lcd.setCursor(0, 0);
      lcd.write(byte(0));
    }
  }
}

void operateMainMenu() {
  int activeButton = 0;
  while (activeButton == 0) {
    int button;
    readKey;
     if(BT1){
      delay(100);
      readKey;
    }
    if ((millis() - lastDebounce) > 30) {
    lastDebounce=millis();
    button = BUTTON();
    switch (button) {
      case 0: // When button returns as 0 there is no action taken
        break;
      case 1:  // This case will execute if the "forward" button is pressed
        button = 0;

        switch (cursorPosition) { // The case that is selected here is dependent on which menu page you are on and where the cursor is.
          case 0:
            menuItem1();
            break;
          case 1:
            menuItem2();
            break;
          case 2:
            menuItem3();
            break;
          case 3:
            menuItem4();
            break;
          case 4:
            menuItem5();
            break;
          case 5:
            menuItem6();
            break;
          case 6:
            menuItem7();
            break;
          case 7:
            menuItem8();
            break;
          case 8:
            menuItem9();
            break;
          case 9:
            menuItem10();
            break;
        }
        activeButton = 1;
        mainMenuDraw();
        drawCursor();
        break;
      case 2:
        button = 0;
        if (menuPage == 0) {
          cursorPosition = cursorPosition - 1;
          cursorPosition = constrain(cursorPosition, 0, ((sizeof(menuItems) / sizeof(String)) - 1));
        }
        if (menuPage % 2 == 0 and cursorPosition % 2 == 0) {
          menuPage = menuPage - 1;
          menuPage = constrain(menuPage, 0, maxMenuPages);
        }

        if (menuPage % 2 != 0 and cursorPosition % 2 != 0) {
          menuPage = menuPage - 1;
          menuPage = constrain(menuPage, 0, maxMenuPages);
        }

        cursorPosition = cursorPosition - 1;
        cursorPosition = constrain(cursorPosition, 0, ((sizeof(menuItems) / sizeof(String)) - 1));

        mainMenuDraw();
        drawCursor();
        activeButton = 1;
        break;
      case 3:
        button = 0;
        if (menuPage % 2 == 0 and cursorPosition % 2 != 0) {
          menuPage = menuPage + 1;
          menuPage = constrain(menuPage, 0, maxMenuPages);
        }

        if (menuPage % 2 != 0 and cursorPosition % 2 == 0) {
          menuPage = menuPage + 1;
          menuPage = constrain(menuPage, 0, maxMenuPages);
        }

        cursorPosition = cursorPosition + 1;
        cursorPosition = constrain(cursorPosition, 0, ((sizeof(menuItems) / sizeof(String)) - 1));
        mainMenuDraw();
        drawCursor();
        activeButton = 1;
        break;
    }
  }
}
}
// This function is called whenever a button press is evaluated. The LCD shield works by observing a voltage drop across the buttons all hooked up to A0.
int BUTTON (){
  int result = 0;
  if (BT4) {
    result = 1; // right
  } else if (BT3) {
    result = 2; // up
  } else if (BT2) {
    result = 3; // down
  } else if (BT1) {
    result = 4; // left
  }
  return result;
}

// If there are common usage instructions on more than 1 of your menu items you can call this function from the sub
// menus to make things a little more simplified. If you don't have common instructions or verbage on multiple menus
// I would just delete this void. You must also delete the drawInstructions()function calls from your sub menu functions.
void drawInstructions() {
  lcd.setCursor(0, 1); // Set cursor to the bottom line
  lcd.print("Use ");
  lcd.print(byte(1)); // Up arrow
  lcd.print("/");
  lcd.print(byte(2)); // Down arrow
  lcd.print(" buttons");
}

void menuItem1() { // Function executes when you select the 1st item from main menu
  int activeButton = 0;

  lcd.clear();
  lcd.setCursor(3, 0);
  lcd.print("Sub Menu 1");

  while (activeButton == 0) {
    int button;
    readKey;
    if (BT1) {
      delay(100);
      readKey;
    }
    button = BUTTON();
    switch (button) {
      case 4:  // This case will execute if the "back" button is pressed
        button = 0;
        activeButton = 1;
        break;
    }
  }
}

void menuItem2() { // Function executes when you select the 2nd item from main menu
  int activeButton = 0;

  lcd.clear();
  lcd.setCursor(3, 0);
  lcd.print("Sub Menu 2");

  while (activeButton == 0) {
    int button;
    readKey;
    if (BT1) {
      delay(100);
      readKey;
    }
    button = BUTTON();
    switch (button) {
      case 4:  // This case will execute if the "back" button is pressed
        button = 0;
        activeButton = 1;
        break;
    }
  }
}

void menuItem3() { // Function executes when you select the 3rd item from main menu
  int activeButton = 0;

  lcd.clear();
  lcd.setCursor(3, 0);
  lcd.print("Sub Menu 3");

  while (activeButton == 0) {
    int button;
    readKey;
    if (BT1) {
      delay(100);
      readKey;
    }
    button = BUTTON();
    switch (button) {
      case 4:  // This case will execute if the "back" button is pressed
        button = 0;
        activeButton = 1;
        break;
    }
  }
}

void menuItem4() { // Function executes when you select the 4th item from main menu
  int activeButton = 0;

  lcd.clear();
  lcd.setCursor(3, 0);
  lcd.print("Sub Menu 4");

  while (activeButton == 0) {
    int button;
    readKey;
    if (BT1) {
      delay(100);
      readKey;
    }
    button = BUTTON();
    switch (button) {
      case 4:  // This case will execute if the "back" button is pressed
        button = 0;
        activeButton = 1;
        break;
    }
  }
}

void menuItem5() { // Function executes when you select the 5th item from main menu
  int activeButton = 0;

  lcd.clear();
  lcd.setCursor(3, 0);
  lcd.print("Sub Menu 5");

  while (activeButton == 0) {
    int button;
    readKey;
    if (BT1) {
      delay(100);
      readKey;
    }
    button = BUTTON();
    switch (button) {
      case 4:  // This case will execute if the "back" button is pressed
        button = 0;
        activeButton = 1;
        break;
    }
  }
}

void menuItem6() { // Function executes when you select the 6th item from main menu
  int activeButton = 0;

  lcd.clear();
  lcd.setCursor(3, 0);
  lcd.print("Sub Menu 6");

  while (activeButton == 0) {
    int button;
    readKey;
    if (BT1) {
      delay(100);
      readKey;
    }
    button = BUTTON();
    switch (button) {
      case 4:  // This case will execute if the "back" button is pressed
        button = 0;
        activeButton = 1;
        break;
    }
  }
}

void menuItem7() { // Function executes when you select the 7th item from main menu
  int activeButton = 0;

  lcd.clear();
  lcd.setCursor(3, 0);
  lcd.print("Sub Menu 7");

  while (activeButton == 0) {
    int button;
    readKey;
    if (BT1) {
      delay(100);
      readKey;
    }
    button = BUTTON();
    switch (button) {
      case 4:  // This case will execute if the "back" button is pressed
        button = 0;
        activeButton = 1;
        break;
    }
  }
}

void menuItem8() { // Function executes when you select the 8th item from main menu
  int activeButton = 0;

  lcd.clear();
  lcd.setCursor(3, 0);
  lcd.print("Sub Menu 8");

  while (activeButton == 0) {
    int button;
    readKey;
    if (BT1) {
      delay(100);
      readKey;
    }
    button = BUTTON();
    switch (button) {
      case 4:  // This case will execute if the "back" button is pressed
        button = 0;
        activeButton = 1;
        break;
    }
  }
}

void menuItem9() { // Function executes when you select the 9th item from main menu
  int activeButton = 0;

  lcd.clear();
  lcd.setCursor(3, 0);
  lcd.print("Sub Menu 9");

  while (activeButton == 0) {
    int button;
    readKey;
    if (BT1) {
      delay(100);
      readKey;
    }
    button = BUTTON();
    switch (button) {
      case 4:  // This case will execute if the "back" button is pressed
        button = 0;
        activeButton = 1;
        break;
    }
  }
}

void menuItem10() { // Function executes when you select the 10th item from main menu
  int activeButton = 0;

  lcd.clear();
  lcd.setCursor(3, 0);
  lcd.print("Sub Menu 10");

  while (activeButton == 0) {
    int button;
    readKey;
    if (BT1) {
      delay(100);
      readKey;
    }
    button = BUTTON();
    switch (button) {
      case 4:  // This case will execute if the "back" button is pressed
        button = 0;
        activeButton = 1;
        break;
    }
  }
}





/*
  #include <LiquidCrystal.h> // include the Liquid Cristal library:
  #include <EEPROM.h> // include the EEPROM library to store last count even after power loose
  #include "setup.h"

  #define enableInterupt  attachInterrupt(digitalPinToInterrupt(SENSOR_PIN),counter_,FALLING)
  #define disableInterupt detachInterrupt(digitalPinToInterrupt(SENSOR_PIN))
  void setup() {
  setup1();
  //LIMIT=10;
  //SET_LIMIT(); //cal set_count function
  //setup2();
  enableInterupt;
  }

  void loop() {
  SetState  = digitalRead(SET_PIN);
  UpState   = digitalRead(UP_PIN);
  DownState = digitalRead(DOWN_PIN);

  SET_LIMIT(); //cal set_count function
  }

  void counter_() {
  while (1) {
    SetState  = digitalRead(SET_PIN);

    if (SetState == LOW) { // This if loop will be executed if the SET button is HIGH
      bool val = digitalRead(SENSOR_PIN); // read the IR_Sensor

      if ( (val == 0) && (hitObject == false) ) { // this code will execute when object in range
        COUNTER++;
        hitObject = true;
        lcd.clear();
        lcd.setCursor(0, 0);
        lcd.print("Counter :" + String (COUNTER) + "    " );
        lcd.setCursor(0, 1);
        lcd.print("LIMIT   :" + String (LIMIT) + "    " );

        if (COUNTER == LIMIT) { // this loop will be executed once the count reach the count limit
          digitalWrite(BUZER_PIN, HIGH); // buzzer ON 30 sec
          lcd.clear();
          lcd.setCursor(3, 0);
          lcd.print("DONE LIMIT");
          disableInterupt;
          delay(3000);
          digitalWrite(BUZER_PIN, LOW);
          break;
        }
      }
      else if ( (val == 1) && (hitObject == true) ) { // this code will execute when object is not in range
        hitObject = false;
      }
    }
  }
  }

  bool ledState = LOW;
  long debounceDelay = 80;
  long lastDebounceTime = 0;

  int button() {
  if ((millis() - lastDebounceTime) > debounceDelay) {
    if ((SetState == HIGH) && (ledState == false) ) {
      digitalWrite(LED_PIN, HIGH);
      lastDebounceTime = millis();
  Serial.print(lastDebounceTime);
      ledState = true;
    }
    else if ((SetState == HIGH) && (ledState == HIGH ) ) {
      digitalWrite(LED_PIN, LOW);
      lastDebounceTime = millis();
      ledState = false;
    }
  }
  }

  int SET_LIMIT() {
  COUNTER = 0;
  button();
  lcd.clear();
  while (ledState == LOW) {
    SetState  = digitalRead(SET_PIN);
    UpState   = digitalRead(UP_PIN);
    DownState = digitalRead(DOWN_PIN);
    button();

    lcd.clear();
    lcd.setCursor(0, 0);
    lcd.print("SET LIMIT :" + String (LIMIT) + "    " );
    delay(20);

    if (UpState == HIGH) //Increase the count Limit
    {
      LIMIT++;
    }

    else if (DownState == HIGH) //Decrese the count Limit
    {
      if (LIMIT > 0) {
        LIMIT--;
      }
    }
  }
  //lcd.clear();
  lcd.setCursor(0, 0);
  lcd.print("LIMIT :");
  enableInterupt;
  if (LIMIT == 0) { // if the count limit is zero then the COUNTER set infinite limit
    lcd.print("~~~~");
  }
  else {
    lcd.setCursor(10, 0);
    lcd.print(LIMIT);
  }
  delay(20);
  }*/