amp_ubc.asm

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

		.include	"x24x_app.h"      
		
		
		.def	Uc_init,Uc_main
		.def	in_Uc    
		.def	out_Uc 
		.ref	amp_dizhi
		   
Uc_shi			.usect	"Udc",1		
in_Uc			.usect "Udc",1
out_Uc			.usect "Udc",1
total_Uc		.usect "Udc",1 
Uc_jishu       .usect "Udc",1 
Uc_dizhi1		.usect "Udc",1 
Uc_dizhi2		.usect "Udc",1  		
				.data
Uc_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
		
Uc_init:  
		LDP		#Uc_shi
		SPLK	#0,Uc_jishu  ;CUN RU SHI GE ZHI DE ZHI ZHEN
		SPLK	#390,Uc_shi ;Q15 JI SHU ,BIAO SHI 1.83/133
		SPLK	#0,Uc_dizhi2  ;ZAI YU PAN DUAN SHI FOU SHI ZUI QIAN MIAN DE SHI GE ZHI 
		SPLK	#0,total_Uc  ;SHI GE ZHI DE HE
		LACC	#Uc_xishu 
		RPT     #132
		TBLW	total_Uc 
		
		RET
		 
Uc_main:   
		SETC	SXM
		SPM		1 
		LDP		#in_Uc
		LACC	in_Uc
		BCND	Uc_1,GT
		NEG
Uc_1:	SACL	in_Uc		
		
		LT		in_Uc
		MPY		Uc_shi         ;0.1 Q15
		PAC
		SACH	in_Uc
		 
		LDP		#Uc_shi   
		LACC	Uc_dizhi2
		BCND	Uc_main2,GT  
		LACC	#Uc_xishu
		ADD		Uc_jishu
   		TBLW	in_Uc   ;JIANG SHU RU DE DANG QIAN ZHI CUN RU  
 
   		LDP		#out_Uc  
   		BLDD	#amp_dizhi,out_Uc

		LACC	total_Uc
		ADD		in_Uc
		SACL	total_Uc 
		
;		LT		total_Uc
;		MPY		Uc_shi         ;0.1 Q15
;		PAC  
;        SACH	total_Uc
        
		LACC	Uc_jishu
		ADD		#1
		SACL	Uc_jishu
		SUB		#133
		BCND	Uc_main1,LT
		SPLK	#1,Uc_dizhi2
		SPLK	#0,Uc_jishu 
		 
		  
		
		B		Uc_main1
Uc_main2:	
		
		
		LACC	#Uc_xishu
		ADD		Uc_jishu
		TBLR	Uc_dizhi1 ;XIANG DANG YI GE ZHONG JIAN 
						;HUAN JIE JIANG TI CHU ZHI
							;SHI CHU 
		TBLW	in_Uc
		LACC	total_Uc
		SUB		Uc_dizhi1
		ADD		in_Uc
		SACL	total_Uc
		SACL	out_Uc
		
		LACC	Uc_jishu
		ADD		#1
		SACL	Uc_jishu
		SUB		#133
		BCND	Uc_main1,LT
		SACL	Uc_jishu
Uc_main1: 

		
		NOP
		NOP 
        RET