c4_4_3.asm

dsp入门与实践一书的源代码

                	.ref start
K_DATA_SIZE 		.set     256
filterdata         	.usect "filter_vars",K_DATA_SIZE

           .data
           .global   test
           .global   inputdata
inputdata:
	.WORD	75,		4595,		-2444,	11368,	15066,	-2014,	-8408,	6957
	.WORD	12879,	-1643,	-5536,	11893,	19128,	4966,		428,		16305
	.WORD	21315,	4595,		-2444,	11368,	15066,	-2014,	-8408,	6957
	.WORD	12879,	-1643,	-5536,	11893,	19128,	4966,		428,		16305
	.WORD	21315,	4595,		-2444,	11368,	15066,	-2014,	-8408,	6957
	.WORD	12879,	-1643,	-5536,	11893,	19128,	4966,		428,		16305
	.WORD	21315,	4595,		-2444,	11368,	15066,	-2014,	-8408,	6957
	.WORD	12879,	-1643,	-5536,	11893,	19128,	4966,		428,		16305
	.WORD	21315,	4595,		-2444,	11368,	15066,	-2014,	-8408,	6957
	.WORD	12879,	-1643,	-5536,	11893,	19128,	4966,		428,		16305
	.WORD	21315,	4595,		-2444,	11368,	15066,	-2014,	-8408,	6957
	.WORD	12879,	-1643,	-5536,	11893,	19128,	4966,		428,		16305
	.WORD	21315,	4595,		-2444,	11368,	15066,	-2014,	-8408,	6957
	.WORD	12879,	-1643,	-5536,	11893,	19128,	4966,		428,		16305
	.WORD	21315,	4595,		-2444,	11368,	15066,	-2014,	-8408,	6957
	.WORD	12879,	-1643,	-5536,	11893,	19128,	4966,		428,		16305
	.WORD	21315,	4595,		-2444,	11368,	15066,	-2014,	-8408,	6957
	.WORD	12879,	-1643,	-5536,	11893,	19128,	4966,		428,		16305
	.WORD	21315,	4595,		-2444,	11368,	15066,	-2014,	-8408,	6957
	.WORD	12879,	-1643,	-5536,	11893,	19128,	4966,		428,		16305
	.WORD	21315,	4595,		-2444,	11368,	15066,	-2014,	-8408,	6957
	.WORD	12879,	-1643,	-5536,	11893,	19128,	4966,		428,		16305
	.WORD	21315,	4595,		-2444,	11368,	15066,	-2014,	-8408,	6957
	.WORD	12879,	-1643,	-5536,	11893,	19128,	4966,		428,		16305
	.WORD	21315,	4595,		-2444,	11368,	15066,	-2014,	-8408,	6957
	.WORD	12879,	-1643,	-5536,	11893,	19128,	4966,		428,		16305
	.WORD	21315,	4595,		-2444,	11368,	15066,	-2014,	-8408,	6957
	.WORD	12879,	-1643,	-5536,	11893,	19128,	4966,		428,		16305
	.WORD	21315,	4595,		-2444,	11368,	15066,	-2014,	-8408,	6957
	.WORD	12879,	-1643,	-5536,	11893,	19128,	4966,		428,		16305
	.WORD	21315,	4595,		-2444,	11368,	15066,	-2014,	-8408,	6957
	.WORD	12879,	-1643,	-5536,	11893,	19128,	4966,		428,		16304   
	                 
          .def    coff_b1,coff_b2,coff_b3,coff_a1,coff_a2,coff_a3
          
coff_b1    .set    1456H        		
coff_b2    .set    3D07H        		
coff_b3    .set    3D07H       		 	
coff_b4    .set    1456H       		 	
coff_a1    .set    -103AH      		 	
coff_a2    .set    430FH        		
coff_a3    .set    -1016H       		
  
          .asg A2,ORIGIN			
          .asg A3,OUTPUT
          .asg B1,coffb1
          .asg B2,coffb2
          .asg B3,coffb3
          .asg B4,coffb4
          .asg B5,coffa1
          .asg B6,coffa2
          .asg B7,coffa3
		.text
start:    
           SUB    A0,A0, A0
           MVKL   inputdata,ORIGIN
           MVKH   inputdata,ORIGIN
           MVKL   filterdata,OUTPUT
           MVKH   filterdata,OUTPUT

           MVKL   coff_b4,coffb4
           MVKL   coff_b3,coffb3
           MVKL   coff_b2,coffb2
           MVKL   coff_b1,coffb1
           MVKL   coff_a3,coffa3
           MVKL   coff_a2,coffa2
           MVKL   coff_a1,coffa1
           
           MVKL   K_DATA_SIZE-4,B0     
           MVKH   K_DATA_SIZE-4,B0
           
FILTER_LOOP:
           LDW    *ORIGIN++,A4      	
           LDW    *ORIGIN++,A5      	
           LDW    *ORIGIN++,A6		
           LDW    *ORIGIN--(8),A7
     	           
           LDW    *OUTPUT++,A8		
           LDW    *OUTPUT++,A9		
           LDW    *OUTPUT++,A10  	

           MPY    A4,coffb4,B9		
           MPY    A5,coffb3,B10
           MV     B9,A0 
           ADD    B10,A0,A0
           
           MPY    A6,coffb2,B9 
           MPY    A7,coffb1,B10
           ADD    B9,A0,A0
           ADD    B10,A0,A0
           
           MPY    A8,coffa3,B9 
           MPY    A9,coffa2,B10
           ADD    B9,A0,A0           
           ADD    B10,A0,A0
           
           MPY    A10,coffa1,B9 

     [B0]  B      FILTER_LOOP    	
           ADD    B9,A0,A0		
           SHR   A0,16,A0		
           STW   A0,*OUTPUT--(8)