udc.asm

此源代码用于电力电子变换器的PID调节

		.include	"x24x_app.h"      
		
		
		.def	Udc_init,Udc_main
		.def	in_Udc    
		.def	out_Udc
		.def	Udc_bef    
Udc_shi			.usect	"Udc",1		
in_Udc			.usect "Udc",1
out_Udc			.usect "Udc",1
total_Udc		.usect "Udc",1 
Udc_jishu       .usect "Udc",1 
Udc_dizhi1		.usect "Udc",1 
Udc_dizhi2		.usect "Udc",1 
Udc_bef         .usect "Udc",1 
Udc_then		.usect "Udc",1 
Udc_2           .usect "Udc",1 
Udc_zhong		.usect "Udc",1 		
Udc_zhong1		.usect "Udc",1 		
				.data
Udc_xishu		.word  0
				.word  0 
				.word  0
				.word  0 
				.word  0
				.word  0 
				.word  0
				.word  0
				.word  0
				.word  0 
			
				
                .text
		
Udc_init:  
		LDP		#Udc_shi
		SPLK	#0,Udc_jishu  ;CUN RU SHI GE ZHI DE ZHI ZHEN
		SPLK	#3277,Udc_shi ;Q15 JI SHU ,BIAO SHI 0.1
		SPLK	#0,Udc_dizhi2  ;ZAI YU PAN DUAN SHI FOU SHI ZUI QIAN MIAN DE SHI GE ZHI 
		SPLK	#0,total_Udc  ;SHI GE ZHI DE HE
		LACC	#Udc_xishu 
		RPT     #9
		TBLW	total_Udc 
		SPLK	#16384,Udc_2    ;2 DE Q13 JI SHU ZHI
		SPLK	#25604,Udc_then
		RET
		 
Udc_main:   
		SETC	SXM
		SPM		1  
;		LDP		#Udc_shi   
;		LACC	Udc_dizhi2
;		BCND	Udc_main2,GT  
;		LACC	#Udc_xishu
;		ADD		Udc_jishu
;   		TBLW	in_Udc   ;JIANG SHU RU DE DANG QIAN ZHI CUN RU 
;		BLDD	#in_Udc,out_Udc
;		LACC	Udc_jishu
;		ADD		#1
;		SACL	Udc_jishu
;		SUB		#10
;		BCND	Udc_main1,LT
;		SPLK	#1,Udc_dizhi2
;		SPLK	#0,Udc_jishu  
;		LACC	in_Udc,3
;		ADD		in_Udc,1
;		SACL	total_Udc
;		B		Udc_main1
;Udc_main2:	
;		LACC	#Udc_xishu
;		ADD		Udc_jishu
;		TBLR	Udc_dizhi1 ;XIANG DANG YI GE ZHONG JIAN 
							;HUAN JIE JIANG TI CHU ZHI
							;SHI CHU 
;		TBLW	in_Udc
;		LACC	total_Udc
;		SUB		Udc_dizhi1
;		ADD		in_Udc
;		SACL	total_Udc
;		LT		total_Udc
;		MPY		Udc_shi         ;0.1 Q15
;		PAC
;		SACH	out_Udc     ;QIU CHU PING JUN ZHI Q13
;		LACC	Udc_jishu
;		ADD		#1
;		SACL	Udc_jishu
;		SUB		#10
;		BCND	Udc_main1,LT
;		SACL	Udc_jishu
Udc_main1:
		NOP
		NOP 
        LT		Udc_then   ;Q13
        MPY		out_Udc   ; YI SHANG LIANG TIAO ZHI LING XIANG
        					;DANG YU QIU SHI CE DE DIAN YA ZHI
        					;YU 514 DE BI ZHI  
        					;Udc_then cai qu de wei Q13 JI SHU
        MPY		in_Udc					
        PAC
        ROL
        ROL   
        SACH	Udc_zhong1		
	;	SPLK	#16384,U 
		SPLK	#8192,Udc_bef   ;DIE DAI DE CHU ZHI ,1 DE Q13
		LAR		AR0,#10
		MAR		*,AR0
Udc_main3:
		NOP
		LT		Udc_bef
		MPY		Udc_zhong1	
	;	MPY		in_Udc
		PAC		
		SUB		Udc_2,14     ;Udc_2,Q13 jiu shu 
		NEG      
		ROL
		ROL
		SACH	Udc_zhong
		MPY		Udc_zhong
		PAC    
		ROL
		ROL
		SACH	Udc_bef         ;Q13
		BANZ    Udc_main3
		NOP
		NOP
		
         RET