6－1三相交流异步电动机无速度传感器磁场定向控制程序.doc

《6－1三相交流异步电动机无速度传感器磁场定向控制程序》 .include x24x_app.h ;----------------------------------------------------------------------------- ; 变量定义 ;----------------------------------------------------------------------------- .bss speed_ref,1 ;速度参考 .bss speed_ref_rpm,1 stack_size .set 20h ;堆栈空间 stack_start .usect stack,stack_size .bss GPR0,1 ;临时变量 .bss sp_loop_cnt,1 ; 速度环计数器 .bss sp_loop_max,1 ;速度PI调节变量定义 .bss spd_fdb ,1 ; 反馈速度 .bss spd_ref,1 ; 速度参考 .bss t_out ,1 ; 控制输出 .bss t_max ,1 ; 最大输出 (Q15) .bss t_min ,1 ;最小输出 (Q15) .bss up_spd ,1 ; 比例项(Q14) .bss up1_spd ,1 ; k-1比例项 (Q14) .bss ui_hi_spd ,1 ;积分项高字 (Q30) .bss ui_lo_spd ,1 ; 积分项低字 .bss ud_hi_spd ,1 ;微分项高字 (Q30) .bss ud_lo_spd ,1 ;微分项低字 .bss Kp_spd ,1 ;比例系数 .bss Ki_spd ,1 ; 积分系数 .bss Kd_spd ,1 ; 微分系数 .bss Kc_spd ,1 ; 积分修正系数 .bss e_spd ,1 ; 速度偏差 .bss uprsat_spd,1 ; 没检验饱和的输出 .bss saterr_spd ,1 ; 饱和偏差 Kp_spd_ .set 28312 ;比例系数 Q15 Ki_spd_ .set 4149 ;积分系数Q31 Kd_spd_ .set 0 ; 微分系数Q14 Kc_spd_ .set 31858 ; 积分修正系数Q15 Umax_spd_ .set 07FFFh ; 最大输出 Umin_spd_ .set 08000h ; 最小输出 ;弱磁控制变量定义 .bss spd_ref_fp,1 ;速度参考 .bss id_ref_fp,1 ;Id参考 .bss spd_abs,1 ;速度参考绝对值 .bss spd_1,1 ; 最高转速 .bss id_1 ,1 ; 最大d轴定子电流 .bss field_tmp1,1 ;临时变量 id_1_ .set 1500h ;最大d轴定子电流(Q15) spd_1_.set4000h ;最高转速 (Q15) ; d轴电流PI调节变量定义 .bss id_fdb ,1 ; 电流反馈 .bss id_ref ,1 ; 电流参考 .bss ud_out ,1 ; 控制电压输出t .bss ud_max ,1 ;最大输出电压 (Q15) .bss ud_min ,1 ; 最小输出电压 (Q15) .bss up_d ,1 ;比例项 (Q14) .bss up1_d ,1 ; k-1积分项 (Q14) .bss ui_hi_d ,1 ; 积分项高字 (Q30) .bss ui_lo_d ,1 ; 积分项低字 .bss ud_hi_d ,1 ;微分项高字(Q30) .bss ud_lo_d ,1 ;微分项低字 .bss Kp_d ,1 ; 比例系数 .bss Ki_d ,1 ; 积分系数 .bss Kd_d ,1 ; 微分系数 .bss Kc_d ,1 ; 积分修正系数 .bss e_d ,1 ; 电流偏差 .bss uprsat_d ,1 ; 没检验饱和的输出 .bss saterr_d ,1 ; 饱和偏差 Kp_d_ .set 21178 ;比例系数 Q15 Ki_d_ .set 4194 ;积分系数Q31 Kd_d_ .se