#include <openGLCD.h>
int vitri=1;
int p_vitri=1;


void nd1()
{
  GLCD.ClearScreen();  // xoa het man hinh
  GLCD.CursorTo(0, 0);
  GLCD.print("-> Mode1"); 
  GLCD.CursorTo(0, 1);
  GLCD.print("   Mode2"); 
  GLCD.CursorTo(0, 2);
  GLCD.print("   Mode3"); 
}
void nd2()
{
  GLCD.ClearScreen();  // xoa het man hinh
  GLCD.CursorTo(0, 0);
  GLCD.print("   Mode1"); 
  GLCD.CursorTo(0, 1);
  GLCD.print("-> Mode2"); 
  GLCD.CursorTo(0, 2);
  GLCD.print("   Mode3");  
}
void nd3()
{
  GLCD.ClearScreen();  // xoa het man hinh
  GLCD.CursorTo(0, 0);
  GLCD.print("   Mode1"); 
  GLCD.CursorTo(0, 1);
  GLCD.print("   Mode2"); 
  GLCD.CursorTo(0, 2);
  GLCD.print("-> Mode3");  
}
void setup() {
  // put your setup code here, to run once:
   // Initialize the GLCD 
  GLCD.Init();
  // Select the font for the default text area
  GLCD.SelectFont(System5x7);

  pinMode(34,INPUT);  // cai 34 input
  pinMode(35,INPUT);  // cai 35 input
  pinMode(36,INPUT);
  pinMode(39,INPUT);

  pinMode(13,OUTPUT);
  pinMode(14,OUTPUT);
  pinMode(15,OUTPUT);
  pinMode(12,OUTPUT);
  
  digitalWrite(13,LOW);
  digitalWrite(14,LOW);
  digitalWrite(15,LOW);
  digitalWrite(12,LOW);
    vitri=1;
    p_vitri=1;
     nd1();

}

void loop() {
  // put your main code here, to run repeatedly:
     if(digitalRead(34)==0)  // kiem tra nhan nut
     {
        vitri--;
        if(vitri<=0)
        {
            vitri =3;
        }
        while(digitalRead(34)==0)
        {}
     }
    if(digitalRead(35)==0)  // kiem tra nhan nut
     {
        vitri++;
        if(vitri>3)
        {
            vitri =1;
        }
        while(digitalRead(35)==0)
        {}
     }
     if(p_vitri!=vitri)
     {
          if(vitri==1)
          {
               nd1();
          }
          else if(vitri==2)
          {
               nd2();
          }
          else if(vitri==3)
          {
              nd3();
          }
       p_vitri = vitri;
     }
}