4*6键盘，各位大虾贤良请不吝赐教

本人做一个4*6键盘，方法如下：采用4*6行列式键盘，行线4根接p3.0-p3.3，列线6根接p2.0-p2.5，先p3.0-p3.3输出低电平，读p2.0-p2.5状态，若全为1，则无键按下，若不全为1，则有键按下；在有键按下的情况下，进一步判断是哪个键按下，使p3.0-p3.3依次输出低电平，读 p2.0-p2.5，即可确定按键位置。
自己按此方法写了一个扫描函数，见附件，我知此地卧虎藏龙，万望某大虾看看，或者重新写一个，先拜谢！
附件：
scan()
{
P3=0xf0;
P2=0x3f;
num=P2&0x3f;
if(num!=0x3f)
{
delay(10);
if(num!=0x3f)
{
P3=0xfe;

key2=P2&0x3f;
if(key2==0x3f)
{
P3=0xfd;
key2=P2&0x3f;
if(key2==0x3f)
{
P3=0xfb;
key2=P2&0x3f;
if(key2==0x3f)
{
// P3=0xf7;
key2=P2&0x3f;
switch(key2)
{
case 0x3e:key=19;break;
case 0x3d:key=20;break;
case 0x3b:key=21;break;
case 0x37:key=22;break;
case 0x2f:key=23;break;
case 0x1f:key=24;break;
default:key=28;
}
}
switch(key2)
{
case 0x3e:key=13;break;
case 0x3d:key=14;break;
case 0x3b:key=15;break;
case 0x37:key=16;break;
case 0x2f:key=17;break;
case 0x1f:key=18;break;
default:key=27;
}
}
switch(key2)
{
case 0x3e:key=7;break;
case 0x3d:key=8;break;
case 0x3b:key=9;break;
case 0x37:key=10;break;
case 0x2f:key=11;break;
case 0x1f:key=12;break;
default:key=26;
}
}
switch(key2)
{
case 0x3e:key=1;break;
case 0x3d:key=2;break;
case 0x3b:key=3;break;
case 0x37:key=4;break;
case 0x2f:key=5;break;
case 0x1f:key=6;break;
default:key=25;
}
}
return(key);
}
}