Multilevel menus working with key repeat

source/main.c

@@ -257,25 +257,6 @@ uint32_t tmp;
 
 
 
-		if (sys.guiMode == GUI_MODE_MENU)
-		{
-			Menu_service();
-		}
-		else
-		{
-			switch(KEY_GetPressed())
-			{
-				case MENU_KEY:
-				{
-	
-					Menu_mainMenu();
-					break;
-	
-				}
-			}
-			Display_Update();
-		}
-
 
 #if !BYPASS_USB_SAFETY
     	if((tickCount++ % 10 == 0) && !GPIO_READ(PIN_VBUS))	//every 10 ticks = 100mS AND !USB
@@ -284,6 +265,28 @@ uint32_t tmp;
 #endif
     	{
 
+			uint32_t pressed = 0;
+
+			if (sys.guiMode == GUI_MODE_MENU)
+			{
+				Menu_service();
+			}
+			else
+			{
+				pressed = KEY_GetPressed();
+	
+				switch(pressed)
+				{
+					case MENU_KEY:
+					{
+		
+						Menu_mainMenu();
+						break;
+		
+					}
+				}
+				Display_Update();
+			}
 
 
 			switch (Task)
@@ -300,7 +303,7 @@ uint32_t tmp;
 				break;
 
 			case PRIMARY_TASK:
-				//pro_key();		// process primary keys front 6 first menu
+				pro_key(pressed);		// process primary keys front 6 first menu
 			break;
 
 			case MENU_TASK:		// Allows user to select options