amp_uab.asm

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

		.include	"x24x_app.h"      
		
		
		.def	Ua_init,Ua_main
		.def	in_Ua    
		.def	out_Ua 
		.def	total_Ua
		.def	Ua_dizhi1
		.def	Ua_jishu
		.def	Ua_dizhi2 
		
		.ref	amp_dizhi
		   
Ua_shi			.usect	"Udc",1		
in_Ua			.usect "Udc",1
out_Ua			.usect "Udc",1
total_Ua		.usect "Udc",1 
Ua_jishu       .usect "Udc",1 
Ua_dizhi1		.usect "Udc",1 
Ua_dizhi2		.usect "Udc",1  		
				.data
Ua_xishu		.word  0
				.word  0 
				.word  0
				.word  0 
				.word  0
				.word  0 
				.word  0
				.word  0
				.word  0
				.word  0 
			    .word  0
				.word  0 
				.word  0
				.word  0 
				.word  0
				.word  0 
				.word  0
				.word  0
				.word  0
				.word  0 
			    .word  0
				.word  0 
				.word  0
				.word  0 
				.word  0
				.word  0 
				.word  0
				.word  0
				.word  0
				.word  0 
			    .word  0
				.word  0 
				.word  0
				.word  0 
				.word  0
				.word  0 
				.word  0
				.word  0
				.word  0
				.word  0 
			    .word  0
				.word  0 
				.word  0
				.word  0 
				.word  0
				.word  0 
				.word  0
				.word  0
				.word  0
				.word  0 
			    .word  0
				.word  0 
				.word  0
				.word  0 
				.word  0
				.word  0 
				.word  0
				.word  0
				.word  0
				.word  0 
			.word  0
				.word  0 
				.word  0
				.word  0 
				.word  0
				.word  0 
				.word  0
				.word  0
				.word  0
				.word  0 
			.word  0
				.word  0 
				.word  0
				.word  0 
				.word  0
				.word  0 
				.word  0
				.word  0
				.word  0
				.word  0 
			.word  0
				.word  0 
				.word  0
				.word  0 
				.word  0
				.word  0 
				.word  0
				.word  0
				.word  0
				.word  0 
			.word  0
				.word  0 
				.word  0
				.word  0 
				.word  0
				.word  0 
				.word  0
				.word  0
				.word  0
				.word  0 
			.word  0
				.word  0 
				.word  0
				.word  0 
				.word  0
				.word  0 
				.word  0
				.word  0
				.word  0
				.word  0 
			.word  0
				.word  0 
				.word  0
				.word  0 
				.word  0
				.word  0 
				.word  0
				.word  0
				.word  0
				.word  0 
			.word  0
				.word  0 
				.word  0
				.word  0 
				.word  0
				.word  0 
				.word  0
				.word  0
				.word  0
				.word  0 
			   .word  0
				.word  0
				.word  0
				
                .text
		
Ua_init:  
		LDP		#Ua_shi
		SPLK	#0,Ua_jishu  ;CUN RU SHI GE ZHI DE ZHI ZHEN
		SPLK	#390,Ua_shi ;Q15 JI SHU ,BIAO SHI 1.83/133
		SPLK	#0,Ua_dizhi2  ;ZAI YU PAN DUAN SHI FOU SHI ZUI QIAN MIAN DE SHI GE ZHI 
		SPLK	#0,total_Ua  ;SHI GE ZHI DE HE
		LACC	#Ua_xishu 
		RPT     #132
		TBLW	total_Ua 
		
		RET
		 
Ua_main:   
		SETC	SXM
		SPM		1 
		LDP		#in_Ua
		LACC	in_Ua
		BCND	Ua_1,GT
		NEG
Ua_1:	SACL	in_Ua		
		
		LT		in_Ua
		MPY		Ua_shi         ;0.1 Q15
		PAC
		SACH	in_Ua
		 
		LDP		#Ua_shi   
		LACC	Ua_dizhi2
		BCND	Ua_main2,GT  
		LACC	#Ua_xishu
		ADD		Ua_jishu
   		TBLW	in_Ua   ;JIANG SHU RU DE DANG QIAN ZHI CUN RU  
 
   		LDP		#out_Ua  
   		BLDD	#amp_dizhi,out_Ua

		LACC	total_Ua
		ADD		in_Ua
		SACL	total_Ua 
		
;		LT		total_Ua
;		MPY		Ua_shi         ;0.1 Q15
;		PAC  
;        SACH	total_Ua
        
		LACC	Ua_jishu
		ADD		#1
		SACL	Ua_jishu
		SUB		#133
		BCND	Ua_main1,LT
		SPLK	#1,Ua_dizhi2
		SPLK	#0,Ua_jishu 
		 
		  
		
		B		Ua_main1
Ua_main2:	
		
		
		LACC	#Ua_xishu
		ADD		Ua_jishu
		TBLR	Ua_dizhi1 ;XIANG DANG YI GE ZHONG JIAN 
						;HUAN JIE JIANG TI CHU ZHI
							;SHI CHU 
		TBLW	in_Ua
		LACC	total_Ua
		SUB		Ua_dizhi1
		ADD		in_Ua
		SACL	total_Ua
		SACL	out_Ua
		
		LACC	Ua_jishu
		ADD		#1
		SACL	Ua_jishu
		SUB		#133
		BCND	Ua_main1,LT
		SACL	Ua_jishu
Ua_main1: 

		
		NOP
		NOP 
        RET