svgen_dq.asm

这个是关于实现同步电机FOC的控制程序源代码

;===========================================================================
; 文件名:	svgen_dq.asm
; 
; 模块名:	SVGEN_DQ
;
; 初始化程序名: SVGEN_DQ_INIT
;
; 公司:	达盛科技
;
; 功能描述:	根据电压空间矢量PWM技术计算三相占空比参考值，以提供合适的
;           定子电压。
;
;		        |~~~~~~~~~~~~~~~|
; Ualfa   o---->|		        |----->o  Ta
;		        |   SVGEN_DQ   	|----->o  Tb
; Ubeta   o---->|		        |----->o  Tc
;		        |_______________|
;
;=====================================================================================
; 修改纪录:
;-------------------------------------------------------------------------------------
; 最后更新日期:2005.6.13	版本号:	Ver 1.0	
;===========================================================================

;---------------------------------------------------------------------------
; 程序调用变量声明
;---------------------------------------------------------------------------
;		.ref	SVGEN_DQ,SVGEN_DQ_INIT		;子程序调用
;		.ref	Ualfa,Ubeta					;输入
;		.ref	Ta,Tb,Tc					;输出

;---------------------------------------------------------------------------
; 相关变量声明及参数定义
;---------------------------------------------------------------------------
		.include "x24x_app.h"

;---------------------------------------------------------------------------
; 变量声明
;---------------------------------------------------------------------------
		.def	SVGEN_DQ,SVGEN_DQ_INIT		;子程序调用
		.def	Ualfa,Ubeta					;输入
		.def	Ta,Tb,Tc					;输出
		
;---------------------------------------------------------------------------
; 变量定义
;---------------------------------------------------------------------------
Ualfa	.usect "svgen_dq",1
Ubeta	.usect "svgen_dq",1
Va		.usect "svgen_dq",1
Vb		.usect "svgen_dq",1
Vc		.usect "svgen_dq",1
Ta		.usect "svgen_dq",1
Tb		.usect "svgen_dq",1
Tc		.usect "svgen_dq",1
sector	.usect "svgen_dq",1		;SVPWM sector    
t1		.usect "svgen_dq",1		;SVPWM T1 
t2		.usect "svgen_dq",1		;SVPWM T2 
half_sqrt3	.usect "svgen_dq",1		;SQRT(3) * 0.5

;名义变量声明
X		.set	Va
Y		.set	Vb
Z		.set	Vc
SR_ADDR	.set	sector
;----------------------------------------------------------

;=============================
SVGEN_DQ_INIT:
;=============================
		ldp	#half_sqrt3
		SPLK 	#28378,half_sqrt3 ; 设置常数 sqrt(3)*0.5 （Q15