LOAF-Robotics/Options.ino at master · MisterEddie/LOAF-Robotics · GitHub

1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
void optionsMenu()
{
  while(digitalRead(49) == HIGH)
  {
    LCD.clear(); LCD.home();
    double subMenu = 0;
    double arrow = analogRead(7);
    if (arrow >= 0 && arrow < 1013/4)
    {
      subMenu = 1;
      LCD.clear(); LCD.home();
      LCD.print("->Drive   Course");
      LCD.setCursor(0,1);
      LCD.print("  IR    Strategy");
    }
    else if (arrow >= 1013/4 && arrow < 1013/2)
    {
      subMenu = 2;
      LCD.clear(); LCD.home();
      LCD.print("  Drive ->Course");
      LCD.setCursor(0,1);
      LCD.print("  IR    Strategy");
    }
    else if (arrow >= 1013/2 && arrow < 1013*3/4)
    {
      subMenu = 3;
      LCD.clear(); LCD.home();
      LCD.print("  Drive   Course");
      LCD.setCursor(0,1);
      LCD.print("->IR    Strategy");
    }
    else if (arrow >= 1013*3/4 && arrow <= 1020)
    {
      subMenu = 4;
      LCD.clear(); LCD.home();
      LCD.print("  Drive   Course");
      LCD.setCursor(0,1);
      LCD.print("  IR  ->Strategy");
    }
    delay(100);
    int buttonON = digitalRead(50);
    if(buttonON == LOW)
    {
      while(digitalRead(50) == LOW){}
      if(subMenu == 1)
      {
        driveMenu();
      }
      else if(subMenu == 2)
      {
        courseSetMenu();
      }
      else if(subMenu == 3)
      {
        irMenu();
      }
      else if(subMenu == 4)
      {
        strategyMenu();
      }
    }
    delay(100);
  }
  while(digitalRead(49) == LOW){}
}