myiirfilter.asm

"采用TMS320VC5402实现一个低通滤波器.rar"

              .mmregs	
                        
K_DATA_SIZE   .set 256
K_BUFFER_SIZE .set 8
K_STACK_SIZE  .set 256
K_A           .set 3 
K_B           .set 4
K_CIR         .set K_BUFFER_SIZE
              
              .def start,_c_int00
STACK         .usect"STACK",K_STACK_SIZE
_c_int00

              
SYSTEM_STACK  .set K_STACK_SIZE+STACK

DATA_DP       .usect"filter_vars",0
filterdata    .usect"filter_vars",K_DATA_SIZE
bufferdatay   .usect"filter_vars",K_DATA_SIZE*2
bufferdatax   .usect"filter_vars",K_DATA_SIZE*2
***************************************************************
              .def start
              .data
			  .global inputdata
inputdata
     .WORD 21315,4595,-2444,11368,15066,-2014,-8408,6957   
     .WORD 12879,-1643,-5536,11893,19128,4966,428,16304
     .WORD 21315,4595,-2444,11368,15066,-2014,-8408,6957   
     .WORD 12879,-1643,-5536,11893,19128,4966,428,16304
     .WORD 21315,4595,-2444,11368,15066,-2014,-8408,6957   
     .WORD 12879,-1643,-5536,11893,19128,4966,428,16304
     .WORD 21315,4595,-2444,11368,15066,-2014,-8408,6957   
     .WORD 12879,-1643,-5536,11893,19128,4966,428,16304
	 .WORD 21315,4595,-2444,11368,15066,-2014,-8408,6957   
     .WORD 12879,-1643,-5536,11893,19128,4966,428,16304
     .WORD 21315,4595,-2444,11368,15066,-2014,-8408,6957   
     .WORD 12879,-1643,-5536,11893,19128,4966,428,16304
     .WORD 21315,4595,-2444,11368,15066,-2014,-8408,6957   
     .WORD 12879,-1643,-5536,11893,19128,4966,428,16304
     .WORD 21315,4595,-2444,11368,15066,-2014,-8408,6957   
     .WORD 12879,-1643,-5536,11893,19128,4966,428,16304
	 .WORD 21315,4595,-2444,11368,15066,-2014,-8408,6957   
     .WORD 12879,-1643,-5536,11893,19128,4966,428,16304
     .WORD 21315,4595,-2444,11368,15066,-2014,-8408,6957   
     .WORD 12879,-1643,-5536,11893,19128,4966,428,16304
     .WORD 21315,4595,-2444,11368,15066,-2014,-8408,6957   
     .WORD 12879,-1643,-5536,11893,19128,4966,428,16304
     .WORD 21315,4595,-2444,11368,15066,-2014,-8408,6957   
     .WORD 12879,-1643,-5536,11893,19128,4966,428,16304
	 .WORD 21315,4595,-2444,11368,15066,-2014,-8408,6957   
     .WORD 12879,-1643,-5536,11893,19128,4966,428,16304
     .WORD 21315,4595,-2444,11368,15066,-2014,-8408,6957   
     .WORD 12879,-1643,-5536,11893,19128,4966,428,16304
     .WORD 21315,4595,-2444,11368,15066,-2014,-8408,6957   
     .WORD 12879,-1643,-5536,11893,19128,4966,428,16304
     .WORD 21315,4595,-2444,11368,15066,-2014,-8408,6957   
     .WORD 12879,-1643,-5536,11893,19128,4966,428,16304

**********************************************************
	              .text
start:            
				  .asg AR2,ORIGIN
				  .asg AR3,INPUT
				  .asg AR4,FILTER
				  .asg AR5,OUTPUT
      
                  SSBX FRCT
                  SSBX INTM
                  LD   #DATA_DP,DP
                  STM  #STACK,SP
				  CALL filter_start
				  NOP
				  NOP
				  NOP 
LOOP
	              B LOOP
                    
				  .def filter_start
                  .def b1,b2,b3,b4,a1,a2,a3

b1           .set 052DH
b2           .set -0f87H
b3           .set 0f87H
b4           .set -052DH
a1           .set -0ebeH
a2           .set 0a46H
a3           .set -0065H
	              .text
filter_start:
	              
				  STM #K_CIR,BK
		          STM #1,AR0
				  STM #inputdata,ORIGIN
				  STM #bufferdatax,INPUT
				  STM #bufferdatay,FILTER
				  STM #filterdata,OUTPUT

				  
                  
				  
				  
				  RPT #K_A-1
				  MVDD *ORIGIN+,*INPUT+0%
				  STM #bufferdatax,INPUT

				  RPT #K_A-1
				  MVDD *INPUT+0%,*FILTER+0%
				  STM #bufferdatay,FILTER
				  STM #bufferdatax,INPUT


				  STM #K_DATA_SIZE-3-1,BRC
                  RPTB filter_end-1
                  MVDD *ORIGIN+,*INPUT
				  RPT #K_B-1-1
				  MAR *INPUT-0%
				  MPY *INPUT+0%,#b4,B
				  LD B,A
				  MPY *INPUT+0%,#b3,B
				  ADD B,A
				  MPY *INPUT+0%,#b2,B
		          ADD B,A
				  MPY *INPUT+0%,#b1,B
			      ADD B,A
***************************************
                  MPY *FILTER+0%,#a3,B 
				  ADD B,A
				  MPY *FILTER+0%,#a2,B 
				  ADD B,A
				  MPY *FILTER+0%,#a1,B 
				  ADD B,A
				  STH A,*FILTER-0%
				  STH A,*OUTPUT+
				  MAR *FILTER-0%
filter_end: 
                  NOP
				  RET
				  .end