1限幅滤波
FILTTER1:
MOV B,A
CLR C
SUBB A,SDAT
JNC FTLTER1
CPL A
INC A
JUGFT1:
SETB A
SUBB A,#DELTY
JNC JUGFT3
MOV A,SDAT
RET
JUGFT3:
MOV A,B
MOV SDAT,A
RET
2限速滤波
FILTER2:
MOV A,20H
CLR C
SUBB A,21H
JNC LOOP0
CPL A
INC A
LOOP0:
MOV 23H,A
MOV A,21H
CLR C
SUBB A,22H
JNC LOOP1
CPL A
INC A
LOOP1
MOV 24H,A
ADD A,23H
RRC A
MOV LIMIT,A
MOV A,23H
CJNE A,LIMIT,DONE1
AJMP DONE3
DONEl:
JC DONE3
MOV A,24H
CJNE A,LIMIT, DONE2
AJMP DONE3
DONE2:
JC DONE3
AJMP DONE4
DONE3:
MOV A,22H
AJMP DONE5
DONE4:
MOV A,21H
ADD A,22H
RRC A
AJMP DONE5
DONE5:
MOV A,21H
DONE6:
RET
LIMIT:
EQU 30H