iir_d.asm

此源代码用于电力电子逆变器的同步锁相实现

;===========================================================================
; File Name:	IIR_D.asm
;
; Module Name: 	IIR_D					      
;
; Initialization Routine: IIR_D_INIT
;
;
; Description:This is a four_order digital filter	
;
; Target dependency:	C2xx core only
;
;
;=====================================================================================
;		.ref		IIR_D, IIR_D_INIT		;function call
;		.ref		Xin_IIRD				;Inputs
;		.ref		Yout_IIRD				;Outputs 
;===========================================================================
;Module definitions for external reference.
		.def		IIR_D, IIR_D_INIT		;function call
		.def		Xin_IIRD				;Inputs
		.def		Yout_IIRD				;Outputs 
;===========================================================================
;Global vars
Xin_IIRD				.usect	"IIR_D"	,1
Yout_IIRD			.usect	"IIR_D"	,1
XD1		        .usect	"IIR_D"	,1
XD2				.usect	"IIR_D"	,1
AD1_1		.usect	"IIR_D",1	
AD1_2		.usect	"IIR_D",1	
AD1_3		.usect	"IIR_D",1	
AD2_1		.usect	"IIR_D",1	
AD2_2		.usect	"IIR_D",1	
AD2_3				.usect	"IIR_D",1	
	
BD1_1		.usect	"IIR_D",1	
BD1_2				.usect	"IIR_D",1	
BD1_3         .usect	"IIR_D",1	
BD2_1		.usect	"IIR_D",1	
BD2_2		.usect	"IIR_D",1	
BD2_3				.usect	"IIR_D",1	

YD1		.usect	"IIR_D",1	
YD2				.usect	"IIR_D",1	
	
ZD				.usect	"IIR_D",1	
YD				.usect	"IIR_D",1   
ZD1			.usect	"IIR_D",1
ZD2			.usect	"IIR_D",1
;
;===============
IIR_D_INIT:
;===============

 		LDP			#Xin_IIRD
 		SPLK		#0,Xin_IIRD
 		SPLK		#0,Yout_IIRD
	    SPLK		#0,XD1
	    SPLK		#0,XD2 
	    SPLK		#0,YD1
	    SPLK		#0,YD2 
	    SPLK		#0,ZD1
	    SPLK		#0,ZD2
	    SPLK		#8CD3H,AD1_1
	    ;SPLK		#732EH,A1_1
	    SPLK		#0A86DH,AD1_2
	   ;SPLK		#5794H,A1_2
	    SPLK		#7071H,AD1_3
	    ;SPLK		#8F90H,A1_3
	    SPLK		#732EH,AD2_1
	    
	    SPLK		#67F8H,AD2_2
	   
	    SPLK		#9353H,AD2_3
	    ;SPLK		#6CAEH,A2_3
	    SPLK		#7E6BH,BD1_1
	    SPLK		#830AH,BD1_2
	    ;SPLK		#7CF6H,B1_2
	    
	    SPLK		#7C54H,BD2_1
	    SPLK		#8739H,BD2_2
	    ;SPLK		#78C8H,B2_2
	  
	   
	    
	     RET

;===========================================================================
; Routine Name:  IIR_BWT4 
;===========================================================================
IIR_D:
 		SETC			SXM           	; Sign extension mode
;       SETC		OVM             ; Overflow mode
     	SPM			1                	; SPM set for Q15 multiplication 	   
		;		SPM			0									;no product shift, acc = Q30

		LDP		#Xin_IIRD  
		LACC	#0
		LT		XD1
		MPY		AD1_2
		APAC	
		SFR
		SFR
		SFR
		SFR
		SFR
		LT		Xin_IIRD
		MPY		AD1_1
		LTA		XD2
		MPY		AD1_3
		APAC
		SFR
		SFR
	    SFR
	    SFR
	    SFR
	    SFR
	    LT		BD1_1
	    MPY		YD1
	    LTA		BD1_2
	    MPY		YD2
	    LTA		BD1_1
	    MPY		YD1
	    APAC
	    SACH	YD
	    LACL	YD1
	    SACL	YD2
	    LACL	YD
	    SACL	YD1
	    
	    LT		XD1
	    MPY		AD2_2
	    PAC
	    SFR
	    SFR
	    SFR
	    SFR
	    LT		Xin_IIRD
	    MPY		AD2_1
	    LTA		XD2
	    MPY		AD2_3
	    APAC
	    SFR
	    SFR
	    SFR
	    SFR
	    SFR
	    SFR
	    LT		BD2_1
	    MPY		ZD1
	    LTA		BD2_2
	    MPY		ZD2
	    LTA		BD2_1
	    MPY		ZD1
	    APAC
	    SACH	ZD
	    LACL	ZD1
	    SACL	ZD2
	    LACL	ZD
	    SACL	ZD1
	    
	    LACL	XD1
	    SACL	XD2
	    LACL	Xin_IIRD
	    SACL	XD1
	    LACL	YD
	    ADD		ZD
	    SACL	Yout_IIRD
	
		RET