;==============================================================
variable_init	.macro
;---------------------------------------------------------------

		DataZero TEMP		;數據區清零
;==============================================================	        	
;一些變量的初始化賦值
;---------------------------------------------------------------
;硬件特性參數賦值
		ldp	#kia/128	;等價于#kia>>7
		splk	#kia_k,kia
                splk	#kib_k,kib
                splk	#ia_OFFSET_K,ia_offset
                splk	#ib_OFFSET_K,ib_offset
                
                		
                splk	#kvdc_k,kvdc

		SPLK	#DT_COM_k,DT_COM 
		                
                SPLK	#TC_k,TC
                ;sdp	TC,RC
                ;splk	#RC_k,RC
                
                ;sdp	RC,QEPCNT                
                ;splk	#QEP_num,QEPCNT
                
                ;ldp	#kuab/128
                ;splk	#kuab_k,kuab
                ;splk	#kubc_k,kubc
                ;splk	#uab_offset_k,uab_offset               
                ;splk	#ubc_offset_k,ubc_offset    
;---------------------------------------------------------------
;電機額定值賦值
		ldp	#wn/128		
		splk	wn_k,wn
		splk	vn_k,vn
;---------------------------------------------------------------
;參考值賦值	
		;LDP	#4
		;SPLK	#w_ref_k,SPDR_org
		;SPLK	#fluxr_ref_k,PRDR
		;isd_ref_cal	fluxr_ref_k,flux_sh,Lm,Lm_sh,isd_ref,i_sh
;---------------------------------------------------------------

;==============================================
;濾波時間常數賦值
;		ldp	#4
;		bldd	#Tr_invt,WC
;		splk	#WC1_k,WC1
;		splk	#WC2_k,WC2		
;		ldp	#5
;		splk	#wci_k,wci
;==============================================
;監控參數賦值
		ldp	#RunEnable/128
		SPLK	#1,RunEnable
				
		ldp	#tinc/128
		splk	#tinc_k,tinc
		splk	#tdec_k,tdec
		
		splk	#w_ref_k,w_opn_obj
		
		;ldp	#zd_method/128

;---------------------------------------------------------------
;============================================== 
;數據區清零     
;=====================================================================
DataZero	.MACRO TEMP

		LAR	AR2, #0200H			;AR2->B0 START ADDRESS
		MAR	*, AR2				;SET ARP=AR2
		ZAC					;SET (ACC)=0
		RPT	#0FFH				;SET REPEAT CNTR FOR 255+1 LOOPS
		SACL	*+				;WRITE ZEROS TO B0 RAM

		LAR	AR2, #0300H			;AR2->B1 START ADDRESSH
		RPT	#0FFH				;SET REPEAT CNTR FOR 255+1 LOOPS
		SACL	*+				;WRITE ZEROS TO B1 RAM

		LAR	AR2, #0060H			;AR2->B2 START ADDRESS
		RPT	#1FH				;SET REPEAT CNTR FOR 31+1 LOOPS
		SACL	*+				;WRITE ZEROS TO B2 RAM
		
		lar	AR2,#9120h
		LDP	#4
		splk	#(0ffffh-9120h),TEMP
		rpt	TEMP
		SACL	*+
;-----------------------------------------------------------------
		.ENDM

;頻率設定變量賦值
		LDP	#5
		SPLK	#0780H,fo		;15hz,Q7
		SPLK	#0A00H,f1		;20hz,Q7
		SPLK	#0C80H,f2		;25hz,Q7
		SPLK	#0F00H,f3		;30hz,Q7
		SPLK	#1180H,f4		;35hz,Q7
		SPLK	#1400H,f5		;40hz,Q7
		SPLK	#1680H,f6		;45hz,Q7
		SPLK	#1900H,f7		;50hz,Q7
		SPLK	#776,ADATAMAX		;ADATAMAX為2.5v對應的776
		SPLK	#25600,fgiven		;fgiven為用戶設定的最大模擬給定電壓對應的頻率，此處需附Q7的值，現在的數值為200*2^7=25600
		SPLK	#0F00H,f_OBJ	    	;假設f_OBJ=30/380*50*2^7
        SPLK	#780H,f_LAST	    	;假設f_LAST=20/380*50*2^7	
        SPLK	#80H,fvar		;每秒鐘頻率變化1Hz,用戶可以根據自己的情況來設置，Q7


		.endm