Отображение меню на жк, реализация на CVAVR Опции

[ps1x]

Ставлю три пива тому, кто даст мне пример (с комментариями) реализации вложенного меню для 2х строчного жк в среде CVAVR. Уже второй день бюсь ап стену, но ничего путного не выходит - то меню которое написал я, уже (недоделаное) занимает 1312 слов . Сдается мне что это не есть гут. Но придумать ничего лучше бесконечных switch case не могу (

[ChaiSER]

Здравствуйте! Понравилась данная реализация меню для ЖКИ. Сделал себе по такому же принципу, но нужно добавить две функции:
1. Вывод текстовой информации на ЖКИ и выход из функции по нажатию ESC.
2. Ввод значения целого числа с клавиатуры (использую клавиатуру 3х4) и выход из функции с сохранением значения по нажатию ENTER и без сохранения по ESC.

Пока разбираюсь с первой функцией вывод текста и выход из неё по ESC. Делаю так:

Код

void func2(void)
{
    do {
        LCDClear(); //очистить LCD
        LCDWriteString("Hello World!"); //вывод строки на LCD
        _delay_ms(1000); //задержка для проверки
    } while (key == ESC); //Для выхода - ESC
}

И получаеться так, что после отображения текста 1сек. меня выбрасывает в меню, хотя возврат должен происходить по нажатию ESC... Что я не так делаю?