inverter.asm

矢量变频器控制源程序

; Programm

;========================================
M_VECT		.SET	060H		;调制深度
M_MAX		.SET	061H		;调制深度最大值
U_THTAT		.SET	062H		;电压矢量与T轴夹角
UA_PHASE		.SET	063H		;A相相位角
PW_LIMP		.SET	064H		;调制正极限
PW_LIMN		.SET	065H		;调制负极限
UDC_SW		.SET	066H		;母线电压滞环标志
N_MODU		.SET	067H		;极限调制过调制过渡次数
T_PWMH		.SET	068H
T_PWML		.SET	069H
UA_SIGN		.SET	06AH
UA_CNT1		.SET	06BH
UA_CNT2		.SET	06CH
PWM_A		.SET	06DH
PWM_AP		.SET	06EH
PWM_AN		.SET	06FH
UB_SIGN		.SET	070H
UB_CNT1		.SET	071H
UB_CNT2		.SET	072H
PWM_B		.SET	073H
PWM_BP		.SET	074H
PWM_BN		.SET	075H
UC_SIGN		.SET	076H
UC_CNT1		.SET	077H
UC_CNT2		.SET	078H
PWM_C		.SET	079H
PWM_CP		.SET	07AH		;C相调制宽度
PWM_CN		.SET	07BH		;C相调制宽度
DT_CMP		.SET	07CH		;死区补偿值
PWM_TMP		.SET	07DH		;PWM中断临时交换单元
;******************************************************************************
I_POLAR1		.SET	216H		;电流极性寄存器
DT_CMP1		.SET	217H		;死区补偿量1
U_SECTOR		.SET	218H		
U_PHASE		.SET	219H		;电压相角
U_SECTOR1		.SET	21AH		;电压扇区1
T0_VECTOR		.SET	21BH		;T0时间寄存器
PWM_MODE		.SET	21CH		;PWM模式寄存器
ACTR_PAT		.SET	21DH		;ACTR模式寄存器
CURRENT_IM	.SET	21EH		;IM分量
CURRENT_IT	.SET	21FH		;IT分量
THETA_MT		.SET	220H		
FRQ_REAL		.SET	221H		;实际运行频率
UDC_AVRL		.SET	222H		;母线电压滤波低字
UDC_AVRH		.SET	223H		;母线电压滤波高字
UDC_VIB		.SET	224H		;母线电压滤波值
DLTA_MVF		.SET	225H		
VIB_COUNT		.SET	226H		
;*******************************************************************************
K_UDCU		.SET	227H		;转化系数：母线电压/输出电压
T_PWMCH		.SET	228H		;半载波周期高字
DLTA_THTAL	.SET	229H		;每载波周期THTA角增量低字
DLTA_THTAH	.SET	22AH		;每载波周期THTA角增量高字
UDC_REF		.SET	22BH		;母线电压基准值
UDC_MAX		.SET	22CH		;母线电压记录最大值
UDC_MIN		.SET	22DH		;母线电压记录最小值
IT_REF		.SET	22EH		;IT设定值
UM_REF		.SET	22FH		;UM前向通道计算值
UT_REF		.SET	230H		;UT前向通道计算值
F_C		.SET	231H		;载波频率
W1_SET		.SET	232H		;当前设定输出频率
W_INT_ACCL	.SET	234H		;转速积分累加低字
W_INT_ACCH	.SET	235H		;转速积分累加高字
W2		.SET	236H		;转差估计
WS_COFF		.SET	237H		;滑差系数
WS_COFF1		.SET	238H		
RUN_STEP		.SET	239H		
MSCNTC		.SET	23CH		;毫秒计数器
MSCNT		.SET	23DH		;毫秒计数器
BRK_CURRENT	.SET	23EH		;制动电流
BRK_CURRENT1	.SET	23FH		;制动电流1
CSFLAG		.SET	241H		;码盘测速标志
NCAP_NUM		.SET	242H		;没有捕获到码盘脉冲的计数次数
DATA_ID		.SET	243H		;校正测速计时单元
NCAP_NUM1		.SET	244H		;没有捕获到码盘脉冲的计数次数
JCF_FLAG		.SET	245H		;接触器检测延时到标志
REALYVALUE	.SET	246H		;触点电平
REALYTIME		.SET	247H		;延时次数
REALY_DLYTIMER	.SET	248H		;JCF检测延时次数
SPI_CNT		.SET	24BH		;SPI调用次数
TORQUE_L		.SET	24DH		
TORQUE_H		.SET	24EH		
F_C1		.SET	24FH		;载频1
IM_INTL_U		.SET	250H		;IM调节器积分累加低字
IM_INT_U		.SET	251H		;IM调节器积分累加高字
DLTA_UM		.SET	252H		;UM分量
DLTA_UT		.SET	253H		;UT分量
IT_INTL		.SET	254H		;IT调节器积分累加低字
IT_INTH		.SET	255H		;IT调节器积分累加高字
IT_FED_WS		.SET	257H		;IT反馈
IT_REF_SET	.SET	259H		;滤波后IT给定
FLY_NUMBER	.SET	25AH		
TORQUE_LIMFLAG	.SET	25BH		;转矩限定标志
WORD_SYS_RST	.SET	25CH		;系统复位字
CUR_ZERO_DLYCOUNT	.SET	25DH		;电流零漂检测延时
CUR_DETETCT_COUNT	.SET	25EH		;电流零漂检测数据
TORQUE_LIMIT	.SET	261H		;转矩限定
TORQUE1		.SET	262H		;转矩低字
TORQUE		.SET	263H		;转矩高字
W_SET_SPI		.SET	264H		;频率设定
RUN_CMD_1		.SET	265H		;命令控制字
VOLTAGE_PWM	.SET	266H		;V/F输出电压
W_SET		.SET	267H		;当前频率设定
PAR_ID		.SET	268H		;参数辩识单元
RUN_CMD		.SET	269H		
;******************************************************************************
STEP		.SET	26AH
SNTCMD		.SET	26BH
SNTADDS		.SET	26CH
SNTDATH		.SET	26DH
SNTDATL		.SET	26EH
SNTCHK		.SET	26FH
RECCMD		.SET	270H
RECADDS		.SET	271H
RECDATH		.SET	272H
RECDATL		.SET	273H
RECCHK		.SET	274H
ADDR_TAB		.SET	275H		;表格首址缓冲单元
SNT_POINT1	.SET	276H		
SNT_POINT2	.SET	277H		
SNT_POINT3	.SET	278H		
SNT_NUM1		.SET	279H		
SNT_NUM2		.SET	27AH		
SNT_NUM3		.SET	27BH		
ADDRES		.SET	27CH		;接收数据的绝对地址缓冲单元
FLAG1		.SET	27DH		;功能码修改标志
ALIGNFLAG		.SET	27EH		
ALIGNCNT		.SET	27FH		
;*******************************************************************************
MOTOR_VOLTAGE	.SET	280H		;电机电压
MOTOR_FREQ	.SET	281H		;电机频率
UDC		.SET	282H		;母线电压
MOTOR_CURRENT	.SET	283H		;电机电流
MOTOR_POWER	.SET	284H		;电机功率
KC_IAD		.SET	285H		;电流放大系数
GAIN_CURRENT_DIS	.SET	286H		;电流微调系数
GAIN_VOLTAGE_DIS	.SET	287H		;电微调系数压
RS		.SET	288H		;定子电阻
RR		.SET	289H		;转子电阻
LS		.SET	28AH		;定子电感
LR		.SET	28BH		;转子电感
LM		.SET	28CH		;励磁电感
LA		.SET	28DH		;电机漏感
IM_REFN		.SET	28EH		;空载激磁电流
ERRORCODE2	.SET	28FH		;核心侧故障代码
CURRENT_U_ERROR	.SET	290H		;U相电流零漂
CURRENT_V_ERROR	.SET	291H		;V相电流零漂
CURRENT_W_ERROR	.SET	292H		;W相电流零漂
VOLTAGE_LU_SET	.SET	293H		;欠压
RS_REAL		.SET	294H		
RR_REAL		.SET	295H		
LS_REAL		.SET	296H		
LR_REAL		.SET	297H		
IM_REAL		.SET	298H		;励磁电感参考值
IM_REAL1		.SET	299H		;电机空载电流参考值
STATUS_RUN	.SET	29AH		;运行状态
CS_W1_MAX		.SET	29BH		;最大输出频率
INVERTER_VOLTAGE	.SET	29CH		;变频器额定电压
K_UAD		.SET	29DH		;母线电压采样转换值
UDC_OV		.SET	29EH		;母线电压
CS_RATED_CURRENT	.SET	29FH		;额定电流
;*******************************************************************************
L_S		.SET	2A0H		;定子电感
L_R		.SET	2A1H		;转子电感
L_M		.SET	2A2H		;互感
L_A		.SET	2A3H		;漏感
LRM		.SET	2A4H		;转子时常倒数
RR_LR		.SET	2A5H		;转子时常
U_REF		.SET	2A6H		;输出电压设定值
IA		.SET	2A7H		;A相电流检测
IB		.SET	2A8H		;B相电流检测
IC		.SET	2A9H		;C相电流检测
IT_FED		.SET	2ADH		;IT反馈值
IM_FED		.SET	2AEH		;IM反馈值

FLUX_THTA		.SET	2AFH		;磁通角
FLUX_THTA0	.SET	2B0H		
WE		.SET	2B1H		;同步速
ISA		.SET	2B2H		
ISB		.SET	2B3H		
USA		.SET	2B4H		
USB		.SET	2B5H		
FLUX_SA		.SET	2B6H		
FLUX_SB		.SET	2B7H		
FLUX_RA		.SET	2B8H		
FLUX_RB		.SET	2B9H		
T_FLUX		.SET	2BAH		;时间常数

SPEED_FEDOLD	.SET	2BBH		;上次速度值
SPEED_FED		.SET	2BCH		;测速值
DATA_A1		.SET	2BDH		;捕获值A1
DATA_A2		.SET	2BEH		;捕获值A2
DATA_B1		.SET	2BFH		;捕获值B1
DATA_B2		.SET	2C0H		;捕获值B2
T3TIMER		.SET	2C1H		;T3定时器值
SPEED_FLAG	.SET	2C2H		;测速标志
SPEED_FED0	.SET	2C3H		;速度反馈值
NBAC_ERR_K	.SET	2C4H		;速度误差

SPEED_PULSE	.SET	2C5H		;计数个数
SHIFT_COUNTER	.SET	2C6H		;移位次数
SPEED_LOWLIM	.SET	2C7H		;低速切换值
SPEED_HIGHLIM	.SET	2C8H		;高速切换值
SPEED_PULSE0	.SET	2C9H		;计数脉冲正值
MOTOR_NP		.SET	2CAH		;电机极对数

IM_FEDLF_LED	.SET	2CBH		;激磁电流滤波值
IT_FEDLF_LED	.SET	2CCH		;IT电流滤波值
IT_REF_LED	.SET	2CDH		;IT给定显示值
I_FED_LED		.SET	2CEH		;实际电流显示值
SPEED_LED		.SET	2CFH		;反馈速度值
I_FED		.SET	2D0H		;电机合成电流
IM_REF		.SET	2D1H		;激磁电流给定
IM_FEDLF		.SET	2D2H		;激磁电流滤波单元
IT_FEDLF		.SET	2D3H		;力矩电流滤波单元

W1_MAX		.SET	2D4H		;最大输出频率
TS_SAMPLE		.SET	2D5H		
EXCI_I_L		.SET	2D6H		
EXCI_I_H		.SET	2D7H		
IM_INTL		.SET	2D9H		;IM积分累加单元
IM_INTH		.SET	2DAH		;IM积分累加单元
DLTA_RS		.SET	2DBH		;RS偏差
KP_RSLOOP		.SET	2DCH		;RS比例系数
KI_RSLOOP		.SET	2DDH		;RS积分系数
WSLM_INTL		.SET	2DEH		;电流限幅积分累加低字
WSLM_INTH		.SET	2DFH		;电流限幅积分累加高字
FREQ_BR		.SET	2E0H		;转折频率
ADD_WS_FLAG	.SET	2E1H		;滑差增益滞环标志
ADD_LA_FLAG	.SET	2E2H		;漏感项滞环标志

K_IAC1		.SET	2E3H		
BRAKE_FLAG	.SET	2E4H		;制动计数器寄存器
BRAKE_USER	.SET	2E5H		;制动使用率
BRAKE_COUNT1	.SET	2E6H		;发高电平次数
BRAKE_COUNT2	.SET	2E7H		;发低电平次数

I_FED_OLD		.SET	2E9H		;上次实际电流
SPEED_ID		.SET	2EAH		;速度辩识值
SPEED		.SET	2EBH		;实际速度
SPEED_DEC_L	.SET	2ECH		
SPEED_DEC_H	.SET	2EDH		
IT_REF_UDC	.SET	2EEH		;母线电压调节IT给定
SIGNAL		.SET	2EFH		;母线电压调节中的标志位
SPEED_UDC		.SET	2F0H		;母线电压调节中记录SPEED——FED的正负符号

VOLTAGE_CTRPWR	.SET	2F2H		;控制电源电压
SPDID_CNT		.SET	2F3H		;速度辩识清零次数
CRT_V_ERROR	.SET	2F4H		;V相电流检测平均值
CRT_W_ERROR	.SET	2F5H		;W相电流检测平均值

BRAKE_COUNT	.SET	2F6H		;制动单元的故障延时
UDCLP3		.SET	2F7H		;直流电压的滤波值
I_FED_OC		.SET	2F8H		;故障电流
I_FED_OC_REAL	.SET	2F9H		;记录的故障电流
CURRENT_IV	.SET	2FBH		;V相电流检测值
CURRENT_IW	.SET	2FCH		;W相电流检测值

DLTA_THTAN2	.SET	300H		
THTA_MAL		.SET	301H		;角度低字
THTA_MAH		.SET	302H		;角度高字
UDCLP2		.SET	303H		;母线电压滤波值2
TIME_BEGIN	.SET	304H		;计时单元
ENCODER_PULSE	.SET	305H		;码盘脉冲数
MOTOR_FREQ1	.SET	306H		;电机频率
DEADTIME		.SET	307H		;死区时间
W1_MAX1		.SET	309H		;最大频率
KP_WLOOP		.SET	30AH		;速度环比例系数
KI_WLOOP		.SET	30BH		;速度环积分系数
ASR1_P		.SET	30EH		;速度比例系数
ASR1_I		.SET	30FH		;速调积分系数
ASR2_P		.SET	310H		;速调比例系数
ASR2_I		.SET	311H		;速调积分系数
ASR_FRQ		.SET	312H		;切换频率
UDCLP4		.SET	313H		;母线电压滤波值
VOLTAGE_OU_SET	.SET	314H		;过压点
FRQ_HL		.SET	315H		;上限频率
FRQ_LL		.SET	316H		;下限频率
INVERTER_CURRENT	.SET	317H		;变频器额定电流
ZERO_SERVO_KP	.SET	318H		;零伺服比例增益
PGO_DIR_SET	.SET	319H		;码盘方向设定
ZEROSPEED_DETECT	.SET	31AH		;零速度检出
ELECTRIC_TORQUE_LIMIT	.SET	31BH	;电动转矩限定
BRAKE_TORQUE_LIMIT		.SET	31CH	;制动转矩限定
I_COEFF		.SET	31DH		;电流比值
PHASE_COUNTER	.SET	31EH		;输出缺相检测次数
PHASE_U_LO	.SET	31FH		;U相电流积分低位
PHASE_U_HI	.SET	320H		;U相电流积分高位
PHASE_V_LO	.SET	321H		;V相电流积分低位
PHASE_V_HI	.SET	322H		;V相电流积分高位
PHASE_W_LO	.SET	323H		;W相电流积分低位
PHASE_W_HI	.SET	324H		;W相电流积分高位
ZSERVO_FLAG	.SET	325H		;零伺服标志
ZSERVO_COUNT	.SET	326H		;零伺服码盘计数个数
TORQUE_LIM_PU1	.SET	327H		
TORQUE_LIM_PU2	.SET	328H		
ZERVO_INTL	.SET	329H		;零伺服位置环积分累加器低字
ZERVO_INTH	.SET	32AH		;零伺服位置环积分累加器高字
MSEC_COUNT	.SET	32BH		
TIMER_BASE1	.SET	32CH		
CAPTURE_START1	.SET	32DH		;飞速跟踪标志计数器
TIMER_START1	.SET	32EH		;0。1S时间基准
A14		.SET	32FH		;飞速跟踪中，捕捉CAP4下降沿个数
A24		.SET	330H		;飞速跟踪中，捕捉CAP3下降沿个数
V_L4		.SET	331H		; CAP4捕捉下降沿超前标志
V_L3		.SET	332H		; CAP3捕捉下降沿超前标志
A11		.SET	333H		; CAP4捕捉下降沿时刻的记录
A12		.SET	334H		; CAP4捕捉下降沿时刻的记录
A13		.SET	335H		; CAP4捕捉下降沿时刻的记录
A21		.SET	336H		; CAP3捕捉下降沿时刻的记录
A22		.SET	337H		; CAP3捕捉下降沿时刻的记录
A23		.SET	338H		; CAP3捕捉下降沿时刻的记录
FLAG_FT		.SET	339H		; 飞速跟踪步骤计数器
FLAG_FT_BAK	.SET	33AH		; 飞速跟踪步骤计数器备份
TIME_MGNTZ	.SET	33BH		; 励磁方向寄存器
TIME_MGNTZ_BAK	.SET	33CH		; 励磁方向寄存器备份
FRQ_PWM		.SET	33DH		; 辩识速度
DIR_FRQ_PWM	.SET	33EH		; 辩识速度方向
M_VF2		.SET	33FH		; 过渡过程中的调制比系数
MWS_FLAG		.SET	340H		; 转子增益修正标志值
CLEAR_FLAG	.SET	341H		; 码盘测速清零标志
RS_ACT		.SET	342H		
RR_ACT		.SET	343H		
LS_ACT		.SET	344H		
LR_ACT		.SET	345H		
LM_ACT		.SET	346H		; 互感实际值
IM_REFN_ACT	.SET	347H		; 空载电流实际值
DEL_COUNT		.SET	348H		; 参数辩识后电平清零计时
INVERTER_TYPE	.SET	349H		; 变频器机型
KP1_WLOOP		.SET	34AH		; 速调KP转换值
KI1_WLOOP		.SET	34BH		; 速调KI转换值