STM #errordata+9,ERRORDATA STM #referdata+9,REFERDATA STM #filter+15,AR1 STM #DATA_SIZE-10-1,BRC RPTB lmsfilter_end SUB B,B RPT #9
LMS *INPUTDATA+,*FILTER+ STH B,*AR1 SUB B,B LD *AR1,B
STL B,*OUTPUTDATA+ SUB *BREFERDATA+,B STL B,*ERRORDATA MPY *ERRORDATA+,#delta,B STH B,*AR1 SUB B,B LD *AR1,B STL B,*AR1 MPY *AR1,#one,B PSHM RSA PSHM REA PSHM BRC
LD *INPUTDATA-,A LD *FILTER-,A STM #9,BRC RPTB circle_end SUB A,A
39
LD B,A
MPY *INPUTDATA-,B STB B,*AR1 SUB B,B LD *AR1,B ADD *FILTER,B STL B,*FILTER- SUB B,B LD A,B NOP Circle_end: NOP NOP
STM #DATA_SIZE-10-1,BRC RPTB lmsfilter_end POPM BRC POPM REA POPM RSA NOP NOP
LD *INPUTDATA+,A LD *INPUTDATA+,A LD *FILTER+,A LD *REFERDATA,A NOP
Lmsfilter_end:RET
.end
40
