i2vd_drv.asm

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

;===========================================================================
; 文件名:	i2vd_drv.asm
;
; 模块名:  ILEG2_DCBUS_DRV
;
; 初始化程序: ILEG2_DCBUS_DRV_INIT
;
; 公司:	达省科技
;
; 功能: 模块用来测量两相线电流 Ia 和 Ib。 线电流 Ic 通过Ia 和 Ib计算得到;
;		模块同时提供了一路直流电压测量功能,可以是母线电压或者外部控制电压。 
;
;
;				                |~~~~~~~~~~~~~~~~~~~~~~~|
;	    Ch_sel  	o---------->|  			   		    |
;	 Imeas_a_gain	o---------->|Q13   	   	   		    |
;	 Imeas_b_gain  	o---------->|Q13  				 Q15|----->o Imeas_a
;	 Vdc_meas_gain	o---------->|Q13 ILEG2_DCBUS_DRV Q15|----->o Imeas_b
;	 Imeas_a_offset	o---------->|Q15 				 Q15|----->o Imeas_c
;	 Imeas_b_offset	o---------->|Q15 				 Q15|----->o Vdc_meas  
;	 Vdc_meas_offseto---------->|Q15 		   			|
;				    			|_______________________|
;
; 相关说明:  
;		电流为双极性信号,电压为单极性信号;  
;       测量到的信号通过下面方式转变成 Q15 格式数据 ;
;           * 电流信号: XOR #8000h 
;           * 电压信号: SFR 然后 AND #7FFFh
;		ADC采样数据为10-bit 长度, 放置于16位长度的结果寄存器中;    
;       所有 ADC 输入信号的范围要求:0->3.3 伏 
;
; 参数范围:
;		1. 电流电压增益范围 -3.999999 --> +3.99999 (Q13)
;		2. 电流电压偏置范围 -0.999999 --> +0.99999 (Q15)
;		3. 电流电压信号范围 -0.999999 --> +0.99999 (Q15)
;		   对应:
;			1.0 x (VrefHi - VrefLo) = +0.999999 (7FFFh)
;			0.5 x (VrefHi - VrefLo) =  0        (0000/FFFFh)
;			0.0 x (VrefHi - VrefLo) = -0.999999 (8000h)
;	
; 采样通道选择设置说明：
;	____________________________________________________________
;	|  未用  	| Vdc_meas 占用	| Imeas_b 占用 | Imeas_a 占用  | 
;	------------------------------------------------------------
;	|  4 bit    |     4 bit		|    4 bit 	   |  4 bit		   | 
;	------------------------------------------------------------
;	Imeas_x/Vdc_meas select:	0,1,2...F	-->	Ch0,1,2,...15
;
; 默认通道对应关系:
;	Imeas_a		Channel 1（techv