主程序
LD SM0.1
CALL 滤波_0

LD SM0.0
CALL 滤波_1

LDN Q1.0
AN Q1.1
CALL 滤波_2
CALL 滤波_3

LD SM0.1
CALL SBR_0

SBR_0
LD SM0.0
MOVR VD50, VD104
MOVR DW#0.1, VD112
MOVR DW#0.1, VD116
MOVR DW#0.3, VD120
MOVR DW#0.0, VD124
MOVB B#100, SMB34
ATCH INT_0, B#10
ENI

滤波0
LD SM0.0
MOVW W#+0, VW0
MOVW W#+128, VW2
MOVD DW#+0, VD10
MOVD DW#+0, VD14
MOVD DW#+0, VD18
CRET

滤波1
LDB= SMB8, B#25
NOT
S Q1.0, B#1

LDB= SMB9, B#0
NOT
AB= SMB9, B#4
S Q1.1, B#1
CRET



滤波2
LD SM0.0
MOVW AIW0, VW12

LDW>= VW12, W#+0
MOVW W#+0, VW10
NOT
MOVW DW#+65535, VW10

LD SM0.0
+D VD10, VD14
INCW VW0

LDW>= VW0, VW2
MOVD VD14, VD18
ENCO VW2, AC1
SRD VD18, AC1
MOVD DW#+0, VD14
MOVW W#+0, VW0

CRET



滤波3
LDW<= VW20, W#+0
R Q0.0, B#1
S Q0.1, B#1

LDW>= VW20, W#+0
S Q0.0, B#1
R Q0.1, B#1

LD SM0.0
MOVW VW20, VW60

CRET



INT_0
LD SM0.0
ITD VW60, AC0
DTR AC0, AC0
/R DW#32000.0, AC0
MOVR AC0, VD100

LD SM0.0
PID VB100, B#0

LD SM0.0
MOVR VD108, AC0
*R DW#32000.0, AC0
ROUND AC0, AC0
DTI AC0, AC0
MOVW AC0, AQW0

majie534@yahoo.com.cn