#include <LiquidCrystal_I2C.h>

#define I2C_ADDR    0x27
#define LCD_COLUMNS 20
#define LCD_LINES   4

LiquidCrystal_I2C lcd(I2C_ADDR, LCD_COLUMNS, LCD_LINES);

const int Pb_OK = 32; // ok / select / menu
const int Pb_UP = 33;
const int Pb_DOWN = 25;
const int Pb_BACK = 26; // back / home

int DITEKAN = LOW;
int BOUNCE = 50;
//--Character Custom-----------------
 byte Heart[]   = {  B00000,  B01010,  B11111,  B11111,  B01110,  B00100,  B00000,  B00000};
 byte Bell[]    = {  B00100,  B01110,  B01110,  B01110,  B11111,  B00000,  B00100,  B00000};
 byte Alien[]   = {  B11111,  B10101,  B11111,  B11111,  B01110,  B01010,  B11011,  B00000};
 byte Check[]   = {  B00000,  B00001,  B00011,  B10110,  B11100,  B01000,  B00000,  B00000};
 byte Speaker[] = {  B00001,  B00011,  B01111,  B01111,  B01111,  B00011,  B00001,  B00000};
 byte Sound[]   = {  B00001,  B00011,  B00101,  B01001,  B01001,  B01011,  B11011,  B11000};
 byte Skull[]   = {  B00000,  B01110,  B10101,  B11011,  B01110,  B01110,  B00000,  B00000};
 byte Lock[]    = {  B01110,  B10001,  B10001,  B11111,  B11011,  B11011,  B11111,  B00000};
 byte bateraiA[]= {  B01111,  B01000,  B11011,  B10111,  B10111,  B11011,  B01000,  B01111};
 byte bateraiB[]= {  B11111,  B00000,  B11111,  B11111,  B11111,  B11111,  B00000,  B11111};
 byte bateraiC[]= {  B11111,  B00001,  B11101,  B11101,  B11101,  B11101,  B00001,  B11111};
 byte sinyalA[] = {  B11111,  B10101,  B10101,  B01110,  B00100,  B00100,  B00100,  B00100};
 byte sinyalB[] = {  B00000,  B00000,  B00000,  B00001,  B00011,  B00111,  B01111,  B11111};


void setup() {
  // Init
  lcd.init();
  lcd.backlight();

  pinMode(Pb_OK, INPUT_PULLUP);
  pinMode(Pb_UP, INPUT_PULLUP);
  pinMode(Pb_DOWN, INPUT_PULLUP);
  pinMode(Pb_BACK, INPUT_PULLUP);

  lcd.createChar(1, Heart);
  lcd.createChar(2, Bell);
  lcd.createChar(3, Alien);
  lcd.createChar(4, Check);
  lcd.createChar(5, Speaker);
  lcd.createChar(6, Sound);
  lcd.createChar(7, Skull);
  lcd.createChar(8, Lock);

  lcd.createChar(9, bateraiA);
  lcd.createChar(10, bateraiB);
  lcd.createChar(11, bateraiC);
  lcd.createChar(12, sinyalA);
  lcd.createChar(13, sinyalB);
}


void loop() {
  lcd.setCursor(0, 0); lcd.write(12);      lcd.setCursor(1, 0); lcd.write(13);
  lcd.setCursor(8, 0); lcd.print("17:08");
  lcd.setCursor(17, 0); lcd.write(9);      lcd.setCursor(18, 0); lcd.write(10);      lcd.setCursor(19, 0); lcd.write(11);
  lcd.setCursor(0, 1);
  lcd.print("       FirMan       ");
  lcd.setCursor(0, 2);
  lcd.print("                    ");
  lcd.setCursor(0, 3);
  lcd.print("[MENU]              ");

  if (digitalRead(Pb_OK) == DITEKAN) {
    delay(BOUNCE);
    while (digitalRead(Pb_OK) == DITEKAN) {}
    lcd.clear();
    menuSetting();
  }
}

void menuSetting() {
//----------------------------------------------------------------------
setMENU1:
  lcd.setCursor(0, 0);
  lcd.print("->Info Device");
  lcd.setCursor(0, 1);
  lcd.print("  Animasi");
  lcd.setCursor(0, 2);
  lcd.print("  Simulasi");
  lcd.setCursor(0, 3);
  lcd.print("[OK]          [HOME]");

  if (digitalRead(Pb_OK) == DITEKAN) {
    delay(BOUNCE);
    while (digitalRead(Pb_OK) == DITEKAN) {}
    lcd.clear();
    goto setSUBMENU1;
  }else if (digitalRead(Pb_UP) == DITEKAN) {
    delay(BOUNCE);
    while (digitalRead(Pb_UP) == DITEKAN) {}
    lcd.clear();
    goto setMENU3;
  }else if (digitalRead(Pb_DOWN) == DITEKAN) {
    delay(BOUNCE);
    while (digitalRead(Pb_DOWN) == DITEKAN) {}
    lcd.clear();
    goto setMENU2;
    }else if (digitalRead(Pb_BACK) == DITEKAN) {
    delay(BOUNCE);
    while (digitalRead(Pb_BACK) == DITEKAN) {}
    lcd.clear();
    goto homeSET;
  }

  goto setMENU1;
//----------------------------------------------------------------------
setMENU2:
  lcd.setCursor(0, 0);
  lcd.print("  Info Device");
  lcd.setCursor(0, 1);
  lcd.print("->Animasi");
  lcd.setCursor(0, 2);
  lcd.print("  Simulasi");
  lcd.setCursor(0, 3);
  lcd.print("[OK]          [HOME]");

  if (digitalRead(Pb_OK) == DITEKAN) {
    delay(BOUNCE);
    while (digitalRead(Pb_OK) == DITEKAN) {}
    lcd.clear();
    goto setSUBMENU2_1of8;
    }else if (digitalRead(Pb_UP) == DITEKAN) {
    delay(BOUNCE);
    while (digitalRead(Pb_UP) == DITEKAN) {}
    lcd.clear();
    goto setMENU1;
  }else if (digitalRead(Pb_DOWN) == DITEKAN) {
    delay(BOUNCE);
    while (digitalRead(Pb_DOWN) == DITEKAN) {}
    lcd.clear();
    goto setMENU3;
  }else if (digitalRead(Pb_BACK) == DITEKAN) {
    delay(BOUNCE);
    while (digitalRead(Pb_BACK) == DITEKAN) {}
    lcd.clear();
    goto homeSET;
  }

  goto setMENU2;
//----------------------------------------------------------------------
setMENU3:
lcd.setCursor(0, 0);
  lcd.print("  Info Device");
  lcd.setCursor(0, 1);
  lcd.print("  Animasi");
  lcd.setCursor(0, 2);
  lcd.print("->Simulasi");
  lcd.setCursor(0, 3);
  lcd.print("[OK]          [HOME]");

  if (digitalRead(Pb_OK) == DITEKAN) {
    delay(BOUNCE);
    while (digitalRead(Pb_OK) == DITEKAN) {}
    lcd.clear();
  }else if (digitalRead(Pb_UP) == DITEKAN) {
    delay(BOUNCE);
    while (digitalRead(Pb_UP) == DITEKAN) {}
    lcd.clear();
    goto setMENU2;
  }else if (digitalRead(Pb_DOWN) == DITEKAN) {
    delay(BOUNCE);
    while (digitalRead(Pb_DOWN) == DITEKAN) {}
    lcd.clear();
    goto setMENU1;
  }else if (digitalRead(Pb_BACK) == DITEKAN) {
    delay(BOUNCE);
    while (digitalRead(Pb_BACK) == DITEKAN) {}
lcd.clear();
    goto homeSET;
  }

  goto setMENU3;
//----------------------------------------------------------------------
  //SUB MENU -----------------------------------------------------------
//----------------------------------------------------------------------
setSUBMENU1:
  lcd.setCursor(0, 0);
  lcd.print(" ini adalah sebuah ");
  lcd.setCursor(0, 1);
  lcd.print("program uji coba");
  lcd.setCursor(0, 2);
  lcd.print("_maulana firmansyah_");
  lcd.setCursor(0, 3);
  lcd.print("              [BACK]");

  if (digitalRead(Pb_BACK) == DITEKAN) {
    delay(BOUNCE);
    while (digitalRead(Pb_BACK) == DITEKAN) {}
    lcd.clear();
    goto setMENU1;
  }

 goto setSUBMENU1;
//----------------------------------------------------------------------
setSUBMENU2_1of8:
  lcd.setCursor(0, 0);
  lcd.print("______Animasi_______");
  lcd.setCursor(4, 1); lcd.write(1);      lcd.setCursor(8, 1);lcd.write(3);     lcd.setCursor(12, 1);lcd.write(5);    lcd.setCursor(16, 1);lcd.write(7);
  lcd.setCursor(4, 2); lcd.write(2);      lcd.setCursor(8, 2);lcd.write(4);     lcd.setCursor(12, 2);lcd.write(6);    lcd.setCursor(16, 2);lcd.write(8);
  lcd.setCursor(0, 3);
  lcd.print("              [BACK]");
  
  lcd.setCursor(2, 1);
  lcd.print("->");

  if (digitalRead(Pb_OK) == DITEKAN) {
    delay(BOUNCE);
    while (digitalRead(Pb_OK) == DITEKAN) {}
    lcd.clear();
    //
  }else if (digitalRead(Pb_UP) == DITEKAN) {
    delay(BOUNCE);
    while (digitalRead(Pb_UP) == DITEKAN) {}
    lcd.clear();
    goto setSUBMENU2_8of8;
  }else if (digitalRead(Pb_DOWN) == DITEKAN) {
    delay(BOUNCE);
    while (digitalRead(Pb_DOWN) == DITEKAN) {}
    lcd.clear();
    goto setSUBMENU2_2of8;
  }else if (digitalRead(Pb_BACK) == DITEKAN) {
    delay(BOUNCE);
    while (digitalRead(Pb_BACK) == DITEKAN) {}
    lcd.clear();
    goto setMENU2;
  }

 goto setSUBMENU2_1of8;
//--------------------
setSUBMENU2_2of8:
  lcd.setCursor(0, 0);
  lcd.print("______Animasi_______");
  lcd.setCursor(4, 1); lcd.write(1);      lcd.setCursor(8, 1);lcd.write(3);     lcd.setCursor(12, 1);lcd.write(5);    lcd.setCursor(16, 1);lcd.write(7);
  lcd.setCursor(4, 2); lcd.write(2);      lcd.setCursor(8, 2);lcd.write(4);     lcd.setCursor(12, 2);lcd.write(6);    lcd.setCursor(16, 2);lcd.write(8);
  lcd.setCursor(0, 3);
  lcd.print("              [BACK]");

  lcd.setCursor(2, 2);
  lcd.print("->");

  if (digitalRead(Pb_OK) == DITEKAN) {
    delay(BOUNCE);
    while (digitalRead(Pb_OK) == DITEKAN) {}
    lcd.clear();
    //
  }else if (digitalRead(Pb_UP) == DITEKAN) {
    delay(BOUNCE);
    while (digitalRead(Pb_UP) == DITEKAN) {}
    lcd.clear();
    goto setSUBMENU2_1of8;
  }else if (digitalRead(Pb_DOWN) == DITEKAN) {
    delay(BOUNCE);
    while (digitalRead(Pb_DOWN) == DITEKAN) {}
    lcd.clear();
    goto setSUBMENU2_3of8;
  }else if (digitalRead(Pb_BACK) == DITEKAN) {
    delay(BOUNCE);
    while (digitalRead(Pb_BACK) == DITEKAN) {}
    lcd.clear();
    goto setMENU2;
  }

 goto setSUBMENU2_2of8;
//--------------------
setSUBMENU2_3of8:
  lcd.setCursor(0, 0);
  lcd.print("______Animasi_______");
  lcd.setCursor(4, 1); lcd.write(1);      lcd.setCursor(8, 1);lcd.write(3);     lcd.setCursor(12, 1);lcd.write(5);    lcd.setCursor(16, 1);lcd.write(7);
  lcd.setCursor(4, 2); lcd.write(2);      lcd.setCursor(8, 2);lcd.write(4);     lcd.setCursor(12, 2);lcd.write(6);    lcd.setCursor(16, 2);lcd.write(8);
  lcd.setCursor(0, 3);
  lcd.print("              [BACK]");

  lcd.setCursor(6, 1);
  lcd.print("->");

  if (digitalRead(Pb_OK) == DITEKAN) {
    delay(BOUNCE);
    while (digitalRead(Pb_OK) == DITEKAN) {}
    lcd.clear();
    //
  }else if (digitalRead(Pb_UP) == DITEKAN) {
    delay(BOUNCE);
    while (digitalRead(Pb_UP) == DITEKAN) {}
    lcd.clear();
    goto setSUBMENU2_2of8;
  }else if (digitalRead(Pb_DOWN) == DITEKAN) {
    delay(BOUNCE);
    while (digitalRead(Pb_DOWN) == DITEKAN) {}
    lcd.clear();
    goto setSUBMENU2_4of8;
  }else if (digitalRead(Pb_BACK) == DITEKAN) {
    delay(BOUNCE);
    while (digitalRead(Pb_BACK) == DITEKAN) {}
    lcd.clear();
    goto setMENU2;
  }

  goto setSUBMENU2_3of8;
//--------------------
setSUBMENU2_4of8:
  lcd.setCursor(0, 0);
  lcd.print("______Animasi_______");
  lcd.setCursor(4, 1); lcd.write(1);      lcd.setCursor(8, 1);lcd.write(3);     lcd.setCursor(12, 1);lcd.write(5);    lcd.setCursor(16, 1);lcd.write(7);
  lcd.setCursor(4, 2); lcd.write(2);      lcd.setCursor(8, 2);lcd.write(4);     lcd.setCursor(12, 2);lcd.write(6);    lcd.setCursor(16, 2);lcd.write(8);
  lcd.setCursor(0, 3);
  lcd.print("              [BACK]");

 lcd.setCursor(6, 2);
 lcd.print("->");

  if (digitalRead(Pb_OK) == DITEKAN) {
    delay(BOUNCE);
    while (digitalRead(Pb_OK) == DITEKAN) {}
    lcd.clear();
    //
  }else if (digitalRead(Pb_UP) == DITEKAN) {
    delay(BOUNCE);
    while (digitalRead(Pb_UP) == DITEKAN) {}
    lcd.clear();
    goto setSUBMENU2_3of8;
  }else if (digitalRead(Pb_DOWN) == DITEKAN) {
    delay(BOUNCE);
    while (digitalRead(Pb_DOWN) == DITEKAN) {}
    lcd.clear();
    goto setSUBMENU2_5of8;
  }else if (digitalRead(Pb_BACK) == DITEKAN) {
    delay(BOUNCE);
    while (digitalRead(Pb_BACK) == DITEKAN) {}
    lcd.clear();
    goto setMENU2;
  }

 goto setSUBMENU2_4of8;
//--------------------
setSUBMENU2_5of8:
  lcd.setCursor(0, 0);
  lcd.print("______Animasi_______");
  lcd.setCursor(4, 1); lcd.write(1);      lcd.setCursor(8, 1);lcd.write(3);     lcd.setCursor(12, 1);lcd.write(5);    lcd.setCursor(16, 1);lcd.write(7);
  lcd.setCursor(4, 2); lcd.write(2);      lcd.setCursor(8, 2);lcd.write(4);     lcd.setCursor(12, 2);lcd.write(6);    lcd.setCursor(16, 2);lcd.write(8);
  lcd.setCursor(0, 3);
  lcd.print("              [BACK]");

 lcd.setCursor(10, 1);
 lcd.print("->");

  if (digitalRead(Pb_OK) == DITEKAN) {
    delay(BOUNCE);
    while (digitalRead(Pb_OK) == DITEKAN) {}
    lcd.clear();
    //
  }else if (digitalRead(Pb_UP) == DITEKAN) {
    delay(BOUNCE);
    while (digitalRead(Pb_UP) == DITEKAN) {}
    lcd.clear();
    goto setSUBMENU2_4of8;
  }else if (digitalRead(Pb_DOWN) == DITEKAN) {
    delay(BOUNCE);
    while (digitalRead(Pb_DOWN) == DITEKAN) {}
    lcd.clear();
    goto setSUBMENU2_6of8;
  }else if (digitalRead(Pb_BACK) == DITEKAN) {
    delay(BOUNCE);
    while (digitalRead(Pb_BACK) == DITEKAN) {}
    lcd.clear();
    goto setMENU2;
    }

 goto setSUBMENU2_5of8;
//--------------------
setSUBMENU2_6of8:
  lcd.setCursor(0, 0);
  lcd.print("______Animasi_______");
  lcd.setCursor(4, 1); lcd.write(1);      lcd.setCursor(8, 1);lcd.write(3);     lcd.setCursor(12, 1);lcd.write(5);    lcd.setCursor(16, 1);lcd.write(7);
  lcd.setCursor(4, 2); lcd.write(2);      lcd.setCursor(8, 2);lcd.write(4);     lcd.setCursor(12, 2);lcd.write(6);    lcd.setCursor(16, 2);lcd.write(8);
  lcd.setCursor(0, 3);
  lcd.print("              [BACK]");

 lcd.setCursor(10, 2);
 lcd.print("->");

  if (digitalRead(Pb_OK) == DITEKAN) {
    delay(BOUNCE);
    while (digitalRead(Pb_OK) == DITEKAN) {}
    lcd.clear();
    //
  }else if (digitalRead(Pb_UP) == DITEKAN) {
    delay(BOUNCE);
    while (digitalRead(Pb_UP) == DITEKAN) {}
    lcd.clear();
    goto setSUBMENU2_5of8;
  }else if (digitalRead(Pb_DOWN) == DITEKAN) {
    delay(BOUNCE);
    while (digitalRead(Pb_DOWN) == DITEKAN) {}
    lcd.clear();
    goto setSUBMENU2_7of8;
  }else if (digitalRead(Pb_BACK) == DITEKAN) {
    delay(BOUNCE);
    while (digitalRead(Pb_BACK) == DITEKAN) {}
    lcd.clear();
    goto setMENU2;
  }

 goto setSUBMENU2_6of8;
//--------------------
setSUBMENU2_7of8:
  lcd.setCursor(0, 0);
  lcd.print("______Animasi_______");
  lcd.setCursor(4, 1); lcd.write(1);      lcd.setCursor(8, 1);lcd.write(3);     lcd.setCursor(12, 1);lcd.write(5);    lcd.setCursor(16, 1);lcd.write(7);
  lcd.setCursor(4, 2); lcd.write(2);      lcd.setCursor(8, 2);lcd.write(4);     lcd.setCursor(12, 2);lcd.write(6);    lcd.setCursor(16, 2);lcd.write(8);
  lcd.setCursor(0, 3);
  lcd.print("              [BACK]");
  lcd.setCursor(14, 1);
  lcd.print("->");

  if (digitalRead(Pb_OK) == DITEKAN) {
    delay(BOUNCE);
    while (digitalRead(Pb_OK) == DITEKAN) {}
    lcd.clear();
    //
  }else if (digitalRead(Pb_UP) == DITEKAN) {
    delay(BOUNCE);
    while (digitalRead(Pb_UP) == DITEKAN) {}
    lcd.clear();
    goto setSUBMENU2_6of8;
  }else if (digitalRead(Pb_DOWN) == DITEKAN) {
    delay(BOUNCE);
    while (digitalRead(Pb_DOWN) == DITEKAN) {}
    lcd.clear();
    goto setSUBMENU2_8of8;
  }else if (digitalRead(Pb_BACK) == DITEKAN) {
    delay(BOUNCE);
    while (digitalRead(Pb_BACK) == DITEKAN) {}
    lcd.clear();
    goto setMENU2;
  }

  goto setSUBMENU2_7of8;
//--------------------
setSUBMENU2_8of8:
  lcd.setCursor(0, 0);
  lcd.print("______Animasi_______");
  lcd.setCursor(4, 1); lcd.write(1);      lcd.setCursor(8, 1);lcd.write(3);     lcd.setCursor(12, 1);lcd.write(5);    lcd.setCursor(16, 1);lcd.write(7);
  lcd.setCursor(4, 2); lcd.write(2);      lcd.setCursor(8, 2);lcd.write(4);     lcd.setCursor(12, 2);lcd.write(6);    lcd.setCursor(16, 2);lcd.write(8);
  lcd.setCursor(0, 3);
  lcd.print("              [BACK]");

  lcd.setCursor(14, 2);
  lcd.print("->");

  if (digitalRead(Pb_OK) == DITEKAN) {
    delay(BOUNCE);
    while (digitalRead(Pb_OK) == DITEKAN) {}
    lcd.clear();
    //
  }else if (digitalRead(Pb_UP) == DITEKAN) {
    delay(BOUNCE);
    while (digitalRead(Pb_UP) == DITEKAN) {}
    lcd.clear();
    goto setSUBMENU2_7of8;
  }else if (digitalRead(Pb_DOWN) == DITEKAN) {
    delay(BOUNCE);
    while (digitalRead(Pb_DOWN) == DITEKAN) {}
    lcd.clear();
    goto setSUBMENU2_1of8;
  }else if (digitalRead(Pb_BACK) == DITEKAN) {
    delay(BOUNCE);
    while (digitalRead(Pb_BACK) == DITEKAN) {}
    lcd.clear();
    goto setMENU2;
  }

 goto setSUBMENU2_8of8;
//----------------------------------------------------------------------

 //----------------------------------------------------------------------
setSUBMENU3_page3:                        
  lcd.setCursor(0, 0);
  lcd.print("_____Simulasi______");
  lcd.setCursor(0, 1);
  lcd.print("->Tes Servo");
  lcd.setCursor(0, 2);
  lcd.print("  Tes LED     ");
  lcd.setCursor(0, 3);
  lcd.print("[OK]          [BACK]");

     if (digitalRead(Pb_OK) == DITEKAN) {
    delay(BOUNCE);
    while (digitalRead(Pb_OK) == DITEKAN) {}
    lcd.clear();
    goto MENU_TesServo_page1;
  }else if (digitalRead(Pb_UP) == DITEKAN) {
    delay(BOUNCE);
    while (digitalRead(Pb_UP) == DITEKAN) {}
    lcd.clear();

  }else if (digitalRead(Pb_DOWN) == DITEKAN) {
    delay(BOUNCE);
    while (digitalRead(Pb_DOWN) == DITEKAN) {}
    lcd.clear();
    goto setSUBMENU3_page4;
  }else if (digitalRead(Pb_BACK) == DITEKAN) {
    delay(BOUNCE);
    while (digitalRead(Pb_BACK) == DITEKAN) {}
    lcd.clear();
    goto setMENU3;
    }

 goto setSUBMENU3_page3;
//----------------------------------------------------------------------
setSUBMENU3_page4:                        
  lcd.setCursor(0, 0);
  lcd.print("_____Simulasi______");
  lcd.setCursor(0, 1);
  lcd.print("  Tes Servo");
  lcd.setCursor(0, 2);
  lcd.print("->Tes LED     ");
  lcd.setCursor(0, 3);
  lcd.print("[OK]          [BACK]");

     if (digitalRead(Pb_OK) == DITEKAN) {
    delay(BOUNCE);
    while (digitalRead(Pb_OK) == DITEKAN) {}
    lcd.clear();
    goto MENU_TesLed;
  }else if (digitalRead(Pb_UP) == DITEKAN) {
    delay(BOUNCE);
    while (digitalRead(Pb_UP) == DITEKAN) {}
    lcd.clear();
    goto setSUBMENU3_page3;
  }else if (digitalRead(Pb_DOWN) == DITEKAN) {
    delay(BOUNCE);
    while (digitalRead(Pb_DOWN) == DITEKAN) {}
    lcd.clear();
     }else if (digitalRead(Pb_BACK) == DITEKAN) {
    delay(BOUNCE);
    while (digitalRead(Pb_BACK) == DITEKAN) {}
    lcd.clear();
    goto setMENU3;
  }

 goto setSUBMENU3_page4;
//----------------------------------------------------------------------

//----------------------------------------------------------------------
MENU_TesServo_page1:
  lcd.setCursor(0, 0);
  lcd.print("->Tes Servo Manual  ");
  lcd.setCursor(0, 1);
  lcd.print("  Tes Servo 90^     ");
  lcd.setCursor(0, 2);
  lcd.print("  Tes Servo Otomatis");
  lcd.setCursor(0, 3);
  lcd.print("[OK]          [BACK]");

     if (digitalRead(Pb_OK) == DITEKAN) {
    delay(BOUNCE);
    while (digitalRead(Pb_OK) == DITEKAN) {}
    lcd.clear();

  }else if (digitalRead(Pb_UP) == DITEKAN) {
    delay(BOUNCE);
    while (digitalRead(Pb_UP) == DITEKAN) {}
    lcd.clear();
    goto MENU_TesServo_page3;
  }else if (digitalRead(Pb_DOWN) == DITEKAN) {
    delay(BOUNCE);
    while (digitalRead(Pb_DOWN) == DITEKAN) {}
    lcd.clear();
    goto MENU_TesServo_page2;
  }else if (digitalRead(Pb_BACK) == DITEKAN) {
    delay(BOUNCE);
    while (digitalRead(Pb_BACK) == DITEKAN) {}
    lcd.clear();
    goto setSUBMENU3_page4;
  }

 goto MENU_TesServo_page1;
//----------------------------------------------------------------------
MENU_TesServo_page2:
  lcd.setCursor(0, 0);
  lcd.print("  Tes Servo Manual  ");
  lcd.setCursor(0, 1);
  lcd.print("->Tes Servo 90^     ");
  lcd.setCursor(0, 2);
  lcd.print("  Tes Servo Otomatis");
  lcd.setCursor(0, 3);
  lcd.print("[OK]          [BACK]");

     if (digitalRead(Pb_OK) == DITEKAN) {
    delay(BOUNCE);
    while (digitalRead(Pb_OK) == DITEKAN) {}
    lcd.clear();
    goto SUBMENU_TesServo90;
  }else if (digitalRead(Pb_UP) == DITEKAN) {
    delay(BOUNCE);
    while (digitalRead(Pb_UP) == DITEKAN) {}
    lcd.clear();
    goto MENU_TesServo_page1;
  }else if (digitalRead(Pb_DOWN) == DITEKAN) {
    delay(BOUNCE);
    while (digitalRead(Pb_DOWN) == DITEKAN) {}
    lcd.clear();
    goto MENU_TesServo_page3;
  }else if (digitalRead(Pb_BACK) == DITEKAN) {
    delay(BOUNCE);
    while (digitalRead(Pb_BACK) == DITEKAN) {}
    lcd.clear();
    goto setSUBMENU3_page4;
  }
  
 goto MENU_TesServo_page2;
//----------------------------------------------------------------------
MENU_TesServo_page3:
  lcd.setCursor(0, 0);
  lcd.print("  Tes Servo Manual  ");
  lcd.setCursor(0, 1);
  lcd.print("  Tes Servo 90^     ");
  lcd.setCursor(0, 2);
  lcd.print("->Tes Servo Otomatis");
  lcd.setCursor(0, 3);
  lcd.print("[OK]          [BACK]");

     if (digitalRead(Pb_OK) == DITEKAN) {
    delay(BOUNCE);
    while (digitalRead(Pb_OK) == DITEKAN) {}
    lcd.clear();
  }else if (digitalRead(Pb_UP) == DITEKAN) {
    delay(BOUNCE);
    while (digitalRead(Pb_UP) == DITEKAN) {}
    lcd.clear();
    goto MENU_TesServo_page2;
  }else if (digitalRead(Pb_DOWN) == DITEKAN) {
    delay(BOUNCE);
    while (digitalRead(Pb_DOWN) == DITEKAN) {}
    lcd.clear();
    goto MENU_TesServo_page1;
  }else if (digitalRead(Pb_BACK) == DITEKAN) {
    delay(BOUNCE);
    while (digitalRead(Pb_BACK) == DITEKAN) {}
    lcd.clear();
    goto setSUBMENU3_page4;
  }

 goto MENU_TesServo_page3;

//----------------------------------------------------------------------
SUBMENU_TesServo90:
  lcd.setCursor(0,0);
  lcd.print(" Mode Servo Netral  ");
  lcd.setCursor(0,1);
  lcd.print("     90 Derajat     ");
  lcd.setCursor(0,3);
  lcd.print("              [BACK]");

 if (digitalRead(Pb_BACK) == DITEKAN) {
    delay(BOUNCE);
    while (digitalRead(Pb_BACK) == DITEKAN) {}
    lcd.clear();
    goto MENU_TesServo_page2;
 }
goto SUBMENU_TesServo90;

//----------------------------------------------------------------------
MENU_TesLed:
  lcd.setCursor(0, 0);
  lcd.print("*****Simulasi******");
  lcd.setCursor(0, 1);
  lcd.print("  SEGERA            ");
  lcd.setCursor(0, 2);
  lcd.print("         HADIR !!    ");
  lcd.setCursor(0, 3);
  lcd.print("              [BACK]");
 if (digitalRead(Pb_BACK) == DITEKAN) {
    delay(BOUNCE);
    while (digitalRead(Pb_BACK) == DITEKAN) {}
    lcd.clear();
    goto setSUBMENU3_page4;
  }

 goto MENU_TesLed;
//----------------------------------------------------------------------
gameCode_ComingSoon:
  lcd.setCursor(0, 0);
  lcd.print("*****Simulasi******");
  lcd.setCursor(0, 1);
  lcd.print("  SEGERA            ");
  lcd.setCursor(0, 2);
  lcd.print("         HADIR !!    ");
  lcd.setCursor(0, 3);
  lcd.print("              [BACK]");
 if (digitalRead(Pb_BACK) == DITEKAN) {
    delay(BOUNCE);
    while (digitalRead(Pb_BACK) == DITEKAN) {}
    lcd.clear();
  }

 goto gameCode_ComingSoon;
//----------------------------------------------------------------------
gameCode_gerbangLogika:


goto gameCode_gerbangLogika;
//----------------------------------------------------------------------
  //homeSET // EXIT //  endSET --------------------------------------------
//----------------------------------------------------------------------
homeSET:
 lcd.clear();
 delay(100);
//----------------------------------------------------------------------

}