#include "U8glib.h"

U8GLIB_SSD1306_128X64 u8g(U8G_I2C_OPT_DEV_0|U8G_I2C_OPT_NO_ACK|U8G_I2C_OPT_FAST);	// Fast I2C / TWI 



// ' Box', 128x64px
const unsigned char bitmap__Box [] PROGMEM = {
	0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 
	0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 
	0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 
	0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 
	0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 
	0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 
	0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 
	0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 
	0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 
	0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 
	0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 
	0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 
	0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 
	0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 
	0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 
	0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 
	0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 
	0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 
	0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 
	0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 
	0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 
	0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 
	0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 
	0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 
	0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 
	0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 
	0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 
	0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 
	0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 
	0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 
	0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 
	0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 
	0x0f, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xf0, 
	0x10, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x08, 
	0x20, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x04, 
	0x40, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x02, 
	0x40, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x02, 
	0x40, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x02, 
	0x40, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x02, 
	0x40, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x02, 
	0x40, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x02, 
	0x40, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x02, 
	0x40, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x02, 
	0x40, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x02, 
	0x40, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x02, 
	0x20, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x04, 
	0x10, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x08, 
	0x0f, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xf0, 
	0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 
	0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 
	0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 
	0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 
	0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 
	0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 
	0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 
	0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 
	0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 
	0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 
	0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 
	0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 
	0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 
	0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 
	0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 
	0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00
};

#define NEXT_BUTTON 6
#define OK_BUTTON 5

int item_next = 0;
int item_select = 0;
int item_select_1 = 0;
int item_select_2 = 0;
int item_select_3 = 0;

int menu_numbers = 2;
int menu_selector = 0;

int menu_automatico = 0;
int menu_manual = 0;
int menu_detener_automatico = 0;
int menu_detener_manual = 0;

char menu_items_0[2] [20] = {
  {"PROBADOR DE BOBINAS"},
  {"SELECCIONE MODO:"}
};


const int NUM_ITEMS = 2;
char menu_items_1[NUM_ITEMS] [20] = {
  {"Automatico"},
  {"Manual"}
};

const int NUM_ITEMS_1 = 2;
char menu_items_2[NUM_ITEMS_1] [20] = {
  {"Comenzar"},
  {"Atras"}
};

char Detener = "Detener";

void setup(void) {
  u8g.setFont(u8g_font_unifont);
  u8g.setColorIndex(1);

  pinMode(NEXT_BUTTON, INPUT_PULLUP);
  pinMode(OK_BUTTON, INPUT_PULLUP);
}

void loop(void) {


  if(digitalRead(NEXT_BUTTON) == LOW && menu_selector == 0){
    item_select = item_select - 1;
    if(item_select < 0){
      item_select = NUM_ITEMS - 1;
    }
  }

	if(digitalRead(NEXT_BUTTON) == LOW && menu_selector == 11 ){
    item_select_1 = item_select_1 - 1;
    if(item_select_1 < 0){
      item_select_1 = NUM_ITEMS_1 - 1;
    }
  }

	if(digitalRead(NEXT_BUTTON) == LOW && menu_selector == 12 ){
    item_select_2 = item_select_2 - 1;
    if(item_select_2 < 0){
      item_select_2 = NUM_ITEMS_1 - 1;
    }
  }

  item_next = item_select + 1;
  if(item_next >= NUM_ITEMS_1){item_next = 0;}



	//al menu automatico
	if(digitalRead(OK_BUTTON) == LOW && item_select == 0){
		menu_selector = 11; 																		
		menu_automatico = menu_automatico + 1;
	}
	
	//al menu manual
	if(digitalRead(OK_BUTTON) == LOW && item_select == 1){
		menu_selector = 12;
		menu_manual = menu_manual + 1;
	}

	//al menu comenzar automatico
	if(digitalRead(OK_BUTTON) == LOW && item_select_1 == 0 && menu_automatico >= 2){
		menu_selector = 13;
		menu_automatico = 0;
		menu_detener_automatico = menu_detener_automatico + 1;
	}

	//al menu comenzar manual
	if(digitalRead(OK_BUTTON) == LOW && item_select_2 == 0 && menu_manual >= 2){
		menu_selector = 13;
		menu_manual = 0;
		menu_detener_manual = menu_detener_manual + 1;
	}

	//al presionar detener automatico
	if(digitalRead(OK_BUTTON) == LOW && menu_detener_automatico >= 2){
		menu_selector = 11;
		menu_automatico = 3;
		menu_detener_automatico = 0;
		item_select = 0;
		item_select_1 = 0;
	}

	//al presionar detener manual
	if(digitalRead(OK_BUTTON) == LOW && menu_detener_manual >= 2){
		menu_selector = 12;
		menu_manual = 3;
		menu_detener_manual = 0;
		item_select = 0;
		item_select_2 = 0;
	}

	if(digitalRead(OK_BUTTON) == LOW && item_select_1 == 1){
		menu_automatico = 0;
		menu_manual = 0;
		menu_selector = 0;
		item_select = 0;
		item_select_1 = 0;
	}

	if(digitalRead(OK_BUTTON) == LOW && item_select_2 == 1){
		menu_automatico = 0;
		menu_manual = 0;
		menu_selector = 0;
		item_select = 0;
		item_select_2 = 0;
	}

/*int num = 123456;
const char numero = num;
int percent = 1234;
char pct[4];
*/

  u8g.firstPage();  
  do {

		if (menu_selector == 0){

			u8g.drawBitmapP(0, 0, 128/8, 64, bitmap__Box);

			u8g.setFont(u8g_font_6x13);
			u8g.drawStr(10, 12, menu_items_0[0]);

 			/*dtostrf(percent,4,0,pct);
			u8g.setPrintPos(10,12);
  		u8g.print(pct);
			*/
			
			u8g.setFont(u8g_font_6x13);
			u8g.drawStr(21, 28, menu_items_0[1]);
		
			switch (item_select)

			{ case 0:
				// Modo seleccionado:
				u8g.setFont(u8g_font_6x13);
				u8g.drawStr(36, 44, menu_items_1[0]);

				// Modo siguiente:
				u8g.setFont(u8g_font_6x13);
				u8g.drawStr(47, 60, menu_items_1[1]);

				break;

				case 1:
				// Modo seleccionado:
				u8g.setFont(u8g_font_6x13);
				u8g.drawStr(47, 44, menu_items_1[1]);

				// Modo siguiente:
				u8g.setFont(u8g_font_6x13);
				u8g.drawStr(36, 60, menu_items_1[0]);

				break;
			}   
		}

		if(menu_selector == 11){
			u8g.drawBitmapP(0, 0, 128/8, 64, bitmap__Box);

			switch (item_select_1)

			{ case 0:
				// Modo seleccionado:
				u8g.setFont(u8g_font_6x13);
				u8g.drawStr(36, 44, menu_items_2[0]);

				// Modo siguiente:
				u8g.setFont(u8g_font_6x13);
				u8g.drawStr(47, 60, menu_items_2[1]);

				break;

				case 1:
				// Modo seleccionado:
				u8g.setFont(u8g_font_6x13);
				u8g.drawStr(47, 44, menu_items_2[1]);

				// Modo siguiente:
				u8g.setFont(u8g_font_6x13);
				u8g.drawStr(36, 60, menu_items_2[0]);

				break;
			}   
		}

		if(menu_selector == 12){
			u8g.drawBitmapP(0, 0, 128/8, 64, bitmap__Box);

			switch (item_select_2)

			{ case 0:
				// Modo seleccionado:
				u8g.setFont(u8g_font_6x13);
				u8g.drawStr(36, 44, menu_items_2[0]);

				// Modo siguiente:
				u8g.setFont(u8g_font_6x13);
				u8g.drawStr(47, 60, menu_items_2[1]);

				break;

				case 1:
				// Modo seleccionado:
				u8g.setFont(u8g_font_6x13);
				u8g.drawStr(47, 44, menu_items_2[1]);

				// Modo siguiente:
				u8g.setFont(u8g_font_6x13);
				u8g.drawStr(36, 60, menu_items_2[0]);

				break;
			}   
		}

		if(menu_selector == 13){
			u8g.drawBitmapP(0, 0, 128/8, 64, bitmap__Box);

				u8g.setFont(u8g_font_9x18);
				u8g.drawStr(96, 29, "RPM");
				
				u8g.setFont(u8g_font_6x13);
				u8g.drawStr(36, 44, "Detener");
			   
		}
  } while( u8g.nextPage() );

}