c4_4_2.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			
           NOP					

           MV     B9,A0 
           
           MPY    A5,coffb3,B9 
           NOP
           ADD    B9,A0,A0
           
           MPY    A6,coffb2,B9 
           NOP
           ADD    B9,A0,A0
           
           MPY    A7,coffb1,B9 
           NOP
           ADD    B9,A0,A0
           
           MPY    A8,coffa3,B9 			
           NOP
           ADD    B9,A0,A0           
  
           MPY    A9,coffa2,B9 
           NOP
           ADD    B9,A0,A0
           
           MPY    A10,coffa1,B9 
           NOP
           ADD    B9,A0,A0
           SHR   A0,16,A0			
           STW   A0,*OUTPUT--(8)		
           NOP
     [B0]  SUB    B0,1,B0			
     [B0]  B      FILTER_LOOP    
           
finish:    	 B    finish			
          .end