zhongxing.asm

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

		.include	"x24x_app.h"    
		.def		in_ta,in_tb,in_tc
		.def		out_a,out_b,out_c
		.def		out_1,out_2,out_3
		.def		ZHONG_MAIN
out_a			.usect	"zhong",1		
out_b			.usect "zhong",1
out_c			.usect "zhong",1
in_ta			.usect	"zhong",1		
in_tb			.usect "zhong",1
in_tc			.usect "zhong",1 
out_1			.usect	"zhong",1		
out_2			.usect "zhong",1
out_3			.usect "zhong",1 
zhong_cha			.usect	"zhong",1		

ZHONG_MAIN:
		
		
		LDP		#in_ta  
		LACC	in_ta
		SUB		in_tc
		BCND	ZHONG_1,LT
		LACC	in_ta
;		SUB		#3000
		SUB		#1500
		BCND	ZHONG_2,LT
;		SPLK	#3000,out_a  
       	SPLK	#1500,out_a
		NEG          
		SACL	zhong_cha
		ADD		in_tb
		SACL	out_b
		LACC	in_tc
		ADD		zhong_cha
		SACL	out_c
		B		ZHONG_3
		NOP
		NOP
ZHONG_2: 
		LACC	in_tc
		BCND	ZHONG_4,GEQ
		NEG
		SPLK	#0,out_c
		SACL	zhong_cha
		ADD		in_ta
		SACL	out_a
		LACC	in_tb
		ADD		zhong_cha
		SACL	out_b
		B		ZHONG_3
		
ZHONG_1:
		NOP
		NOP
		LACC	in_tc
;		SUB		#3000
		SUB		#1500
		BCND	ZHONG_5,LT
		SACL	zhong_cha
;		SPLK	#3000,out_c
		SPLK	#1500,out_c
		NEG
		ADD		in_tb
		SACL	out_b
		LACC	in_ta
		SUB		zhong_cha
		SACL	out_a
		B		ZHONG_3
ZHONG_5:
		NOP
		NOP
		LACC	in_ta
		BCND	ZHONG_4,GEQ
		SACL	zhong_cha
		NEG
		SPLK	#0,out_a
		ADD		in_tb
		SACL	out_b
		LACC	in_tc
		SUB		zhong_cha
		SACL	out_c
		B		ZHONG_3
ZHONG_4:
		NOP
		NOP
		BLDD	#in_ta,out_a
		BLDD	#in_tb,out_b
		BLDD	#in_tc,out_c
		
ZHONG_3:
		NOP
		NOP
		LACC    out_a
		SUB		out_b
		SACL	out_1
	    LACC	out_b
	    SUB		out_c
	    SACL	out_2
	    LACC	out_c
	    SUB		out_a
	    SACL	out_3
		
		
		
		    
		RET