Проблема с преобразованиями Опции

[max_mart]

Здравствуйте.
Реализую клавиатуру числовую 0-9. Для окончания ввода использую клавишу принятия ввода. Работаю с 1,2,3,4,5 значными цифрами, если введено чило, содержащее более 5 цифр, то ошибка. Как преобразовать из двоично-десятичной формы в двоичную знаю.
Но вот как реализовать сохранение группы нажатых цифр в одну переменную 16-битную - вот проблема. Например ввели число 4563, надо чтобы оно было сохранено в 16-битной переменнойи и цифры были сохранены в нужной мне последовательности после нажатия клавиши "accept".
Помогите, пожалуйста, в данной проблеме?

[max_mart]

Во первых я замарачиваться не стал сделал клаву просто от ножки МК через резистор на конпку.
Во вторых цифре от 0-9 соответствует 4 разрядный двоичный код, поэтому 5 цифр числа просто в 16-битную пер. не уместится, если исп. ее для хран. нажатой цифры.
И как я уже выше написал: Я не пойму только одного момента: как мне сохранить нажатый код цифры, ячтобы в дальнейшем ее расчитать и получить нужное мне число.
Вот пример на 6 цифрах:
unsigned char counter=0; // для подсчета кол-ва введенных цифр
unsigned key[6]; // массив для хранения цифры для опред. кнопки
unsigned int addr=0;

if (!ZERO)
{

writed(10); // 0 on LCD
key[0]=0;
counter++;
}
if (!ONE)
{
if (pp == 0)
{
writed(1); // 1 on LCD
key[1]=1;
counter++;
}
pp=10000;
}
if (!TWO)
{
if (pp == 0)
{
writed(2); // 2 on LCD
key[2]=2;
counter++;
}
pp=10000;
}
if (!THREE)
{
if (pp == 0)
{
writed(3); // 3 on LCD
key[3]=3;
counter++;
}
pp=10000;
}
if (!FOUR)
{
if (pp == 0)
{
writed(4); // 4 on LCD
key[4]=4;
counter++;
}
pp=10000;
}
if (!FIVE)
{
if (pp == 0)
{
writed(5); // 5 on LCD
key[5]=5;
counter++;
}
pp=10000;
}

if (!ACCEPT) // accept input data(end of inputting data)
{
if (pp == 0)
{
if (counter == 1) // 1 digit
{
// надо сохр введеные цифры в пер. addr, чтобы получить 1 значное число
counter=0;
//..

}
if (counter == 2) // 2 digits
{
// надо сохр введеные цифры в пер. addr, чтобы получить 2 значное число
counter=0;
//..

}
if (counter == 3) // 3 digits
{
// надо сохр введеные цифры в пер. addr, чтобы получить 3 значное число
counter=0;
//..

}
if (counter == 4) // 4 digits
{
// надо сохр введеные цифры в пер. addr, чтобы получить 4 значное число
counter=0;
//..

}
if (counter == 5) // 5 digits
{
// надо сохр введеные цифры в пер. addr, чтобы получить 5 значное число

counter=0;
//..

}
if (counter > 5)
{
counter=0;
// отображаю ошибку


}
Вот как мне сохр. в пер. addr я не знаю.
Я знаю что, чтобы получить например число 453 из введенных цифр надо просто: 4*100+5*10+3=453 в 16 битной переменной.
Но я не знаю как мне их сохранять при нажатии клавиши, чтобы не потерять последовательность.
Помогите, пожалуйста с кодом? Дописать его, чтобы реализовать задуманное.