51单片机STC89C52 矩阵键盘数码管显示

WELA BIT P2.7
DULA BIT P2.6
DIOLA BIT P2.5
FM BIT P2.3

ORG 0000H
SETB DIOLA
MOV SP,#0E0H
LOOP0:
LCALL key_Scan
JZ LOOP0
LCALL DELAY20MS
LCALL key_Scan
JZ LOOP0
MOV P1,A
LCALL Smg
HERE0:
LCALL key_Scan ;等待按键释放
JZ LOOP0
LCALL DELAY20MS
SJMP HERE0

key_Scan:
SETB RS1
MOV P3,#0FH
ORL P3,#0FH
MOV A,P3  ;取低4位 行
MOV P3,#0F0H
ORL P3,#0F0H
MOV R0,P3 ;取高4位 列
ANL A,#0FH
MOV R1,A
MOV A,R0
ANL A,#0F0H
ORL A,R1
CPL A
JZ EXIT ;为0说明无键，退出
MOV R0,A ; 暂存完整键状态
ANL A,#0FH
CJNE A,#01H,NEXT0
MOV R1,#1
SJMP NEXT4
NEXT0:
CJNE A,#02H,NEXT1
MOV R1,#2
SJMP NEXT4
NEXT1:
CJNE A,#04H,NEXT2
MOV R1,#3
SJMP NEXT4
NEXT2:
CJNE A,#08H,NEXT3
MOV R1,#4
SJMP NEXT4
NEXT3:
MOV R1,#0 ;R1保存行号 无键为0，有键1-4
CLR A ;退出前，清零累加器
SJMP EXIT
NEXT4:
MOV A,R0  ;开始算列
ANL A,#0F0H
CJNE A,#10H,NEXT00 
MOV R2,#1
SJMP NEXT40
NEXT00:
CJNE A,#20H,NEXT10
MOV R2,#2
SJMP NEXT40
NEXT10:
CJNE A,#40H,NEXT20
MOV R2,#3
SJMP NEXT40
N