我需要用4*4矩阵键盘输入位数最多为四位的多位数。我要实现输入0-9时，键盘可以继续输入，液晶1602保持不变，输入10-15时，液晶1602显示我所输入的数值。我写了键盘扫描程序，但是组合起来就不会写了，尝试了很多方法，总是不能成功，以下是我的部分代码，大神能否帮我看看。我觉得主要是逻辑的问题。
void count()
{
        uchar sn;
        uint num1=0;
        sn=key1();//这是键盘扫描程序，16个按键分别返回0-15
        while(sn<10)//当输入0-9时，键盘可以继续输入
        {
                num1=num1*10+sn;
                sn=key1();
        }
        write_f(num1);//输入10-15将我输入的多位数送到1602显示，write_f()是显示函数。
}