;===========================================================================
; 文件名:	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