typedef struct
{
  char menu_str[LCD_WIDTH+1];
  MENU_HANDLER_PROC func;
} S_MENU_ITEM;

void ShowMenu(S_MENU_ITEM *menu, int element0, int cursor_pos)
{
  ...
}

void Menu(S_MENU_ITEM *menu)
{
  char ret_menu = 0;
  int cursor = 0;
  int element0 = 0;
  while (!ret_menu)
  {
    ShowMenu(menu, element0, cursor);
    switch(ch)
    {
    case VK_UP:
      // перемещаем вверх курсор, если он не 0, либо первый выводимый элемент меню (element0)
      // ...
      break;
    case VK_DOWN:
      // то же самое, только с точностью до наоборот
      // ...
      break;
    case VK_ENTER:
      menu[element0+cursor].func();
      break;
    case VK_EXIT:
      ret_menu = 1;
      break;
    }
  }
}

switch (frame_index)
{                
    ....
    
    case FRAME_SET_TIME:
    case FRAME_SET_DATE:
        switch (button_mask)
        {
            case BTN_YES:    
                if(systime_set(&systime_input))
                {// Неправильный ввод    
                    // Если время введено неправильно,
                    // то возвращаться следует в этот кадр
                    stack_push(&frame_stack,frame_index);
                    frame_index = FRAME_INVALID_DATA;
                }
                else
                    frame_index = FRAME_SET_DONE;
                
                print_flag = 1;
                break;
                
            case BTN_NO:
                frame_index = stack_pop(&frame_stack);
                print_flag = 1;
                break;
    ...    
}

while(1)
{
   .......
   if(MAIN_NOT_BUSY) //условие, дающие разрешение на работу терминала в этом цикле
     next_terminal_task();
}

/****************************************************************/
/* Menu */
/****************************************************************/
// Структура хранящая пункты меню
typedef
struct {
unsigned char __flash *itemText; // Название Пункта
void (*itemFunction)(char); // Вызываемая функция
char itemArg; // Аргумент
}
_menuItem;
_menuItem MenuItem;

// Названия
static __flash unsigned char
_max[] = {77,65,88,32,72,97,190,112,0},
_min[] = {77,73,78,32,72,97,190,112,0},
_sens[] = {171,121,179,99,191,179,184,191,0},
_timeout[] = {84,105,109,101,32,79,117,116,0},
_beep[] = {66,101,101,112,72,114,115,20,0},
_sec[] = {83,104,111,119,32,83,101,99,0},
_stime[] = {83,101,116,32,84,105,109,101,0},
_deadzone[] = {68,101,97,100,90,111,110,101,0},
_service[] = {42,42,42,42,42,42,42,42,0};


// Загрузка структуры
static _menuItem __flash MenuItems[] =
{
_max, SetMaxV, 3,
_min, SetMinV, 2,
_sens, Sensitivity, 0,
_timeout, SetTimeOut, 0,
_deadzone, SetDead, 0,
_beep, SetBeepHrs, 0,
_sec, SetShowSec, 0,
_stime, SetTime, 0,
_service, Service, 0
};
/****************************************************************/

void Menu(char inp)
{
static _menuItem __flash *_mptr = MenuItems;
switch (inp)
{
case NEXT: // Next item
if (++_mptr > &MenuItems[(sizeof MenuItems)/(sizeof (_menuItem)) - 1])
_mptr = MenuItems;
OutStrFlash(_mptr->itemText,0x01);
PrintSymbol(4,0x00);
/* Вывод следующего пункта в след. строку */
if (++_mptr > &MenuItems[(sizeof MenuItems)/(sizeof (_menuItem)) - 1])
{
_mptr = MenuItems;
}
OutStrFlash(_mptr->itemText,0x40);
if (--_mptr < MenuItems) // Set pointer to the last item
_mptr = &MenuItems[(sizeof MenuItems)/(sizeof (_menuItem)) - 1];
Dev_State = MENU;
break;

case SELECT: // Выполнение выбранного пункта
Ctrl = 0;
Dev_State = MENU;
(*_mptr->itemFunction)(_mptr->itemArg);
ClrScr();
break;
}
}