anh chị giúp em cái bàn phím hex này

[ylotus]

em vừa làm xong cái mạch bàn phím hex đang tính test thử xem chạy không mà loay hoay hoài viết cái code ko xong, em đọc sách và xem trên mạng nên viết theo hiểu biết và nó không chạy j hết, anh chị nào có cái code test bàn phím hẽ cho em xin đc không ak (Assembly)

đây là mạch mô phỏng của em

[namngockute]

đây là code test ban phim 4x4 nhưng bằng c
#include <at89x52.h>
#define led P1
#define keyhex P2

#define col1 P2_4
#define col2 P2_5
#define col3 P2_6
#define col4 P2_7


unsigned char x,sophim,i,j[2],y;
unsigned char code num[4][4]={1,2,3,0x0a,
4,5,6,0x0b,
7,8,9,0x0c,
0x0d,0,0x0e,0x0f};

unsigned char getkey()
{
x = 0xfe;
for(i=0; i<4; i++)
{
keyhex = x;
x<<=1;

if(col1 == 0){
sophim = num[i][0];
return sophim;
break;
}
if(col2 == 0){
sophim = num[i][1];
return sophim;
break;
}
if(col3 == 0){
sophim = num[i][2];
return sophim;
break;
}
if(col4 == 0){
sophim = num[i][3];
return sophim;
break;
}

}
return sophim;
}

void main(void)
{
sophim = 0;
i = 0;
while(1)
{
if(getkey()!=0xff)
{
led=getkey();

}

}
}

[namngockute]

đây là bằng hợp ngữ. năn nỉ mãi ông thầy mới chịu rời vợ ra để trả lời mình mấy câu hỏi đấy(heheh vì muộn rùi mà)


KEY_ROW1 equ 0EFh
KEY_ROW2 equ 0DFh
KEY_ROW3 equ 0BFh
KEY_ROW4 equ 07Fh

keyflags: ds 16



RSEG ?PR?input?KEYPAD
input:




keyscan: push DPH
push DPL

mov R0,#keyflags
mov R1,#KEY_ROW1
address
mov R2,#4
ksrow: mov P2,R1
nop
mov A,P1
mov R3,#4
anl A,#3Fh
ks0: rrc A
mov R4,A
jc ks1
mov A,@R0
mov @R0,#1
jz ksnew
jmp ks2
ks1: mov @R0,#0
ks2: inc R0
mov A,R4
djnz R3,ks0

mov A,R1
rl A
mov R1,A
djnz R2,ksrow

clr A
mov R7,A
jmp ksend


ksnew: mov DPTR,#keycodes
last time:
mov A,R0
clr C
subb A,#keyflags
movc A,@A+DPTR
mov R7,A
ksend: mov P2,#0FFh
pop DPL
pop DPH
ret

;Data tables for returned row bits
keycodes: db '7','8','9', '/'
db '4','5','6', '*'
db '1','2','3', '-'
db 'C','0','=', '+'

END