[发明专利]两相混合式步进电机失步判别方法

说明书

本发明涉及一种两相混合式步进电机失步判别方法。采用两相正余弦电流跟踪开环控制，将两相电压和电流作为输入信号，通过非线性观测器观察两相步进电机转子电角度位置，而后对转子电角度位置差分得出转子速度估计值，并与给定速度信号计算两者相对误差，若相对误差超过设定的阈值，则判别出该两相步进电机开环控制失步，关闭电机驱动，从而提高低成本步进电机伺服系统安全性。

技术领域

本发明涉及一种两相混合式步进电机失步判别方法。

背景技术

低成本步进电机伺服系统一般采用开环控制，但由于步进电机的最大输出转矩随速度升高而下降，开环控制工况下响应能力和抗负载波动的能力差，中高速阶段速度脉动加大、振荡等问题。运行过程中如果存在负载突变、过大以及运动速度规划曲线不合理，都将导致步进电机失步。

发明内容

本发明的目的在于提供一种两相混合式步进电机失步判别方法，能够提高低成本步进电机伺服系统安全性。

为实现上述目的，本发明的技术方案是：一种两相混合式步进电机失步判别方法，采用两相正余弦电流跟踪开环控制，将两相电压和电流作为输入信号，通过非线性观测器观察两相步进电机转子电角度位置，而后对转子电角度位置差分得出转子速度估计值，并与给定速度信号计算两者相对误差，若相对误差超过设定的阈值，则判别出该两相步进电机开环控制失步，关闭电机驱动。

在本发明一实施例中，该方法具体实现方式如下：

两相混合式步进电机AB相的数学模型为

式中：R、L为步进电机电阻、电感；i_a、i_b、u_a、u_b为AB相电流电压；p为微分算子，θ为步进电机转子电角度，ω_e为步进电机转子电角度、ψ_f为步进电机磁链；

假设变量为

相对应的观测变量为

根据上位机给定的电机两相电流幅值i_max和电机要求的运行速度ω，确定步进电机开环控制两相正余弦电流给定信号；

而后，执行如下步骤：

S1、根据运行速度ω和步进电机运行电流设定幅值，其中步进电机转子位置θ(k)＝∫ω(k)，确定a轴给定的电流信号i_a(k)＝i_maxsin(θ(k))、b轴给定的电流信号i_b(k)＝i_maxcos(θ(k))和电流流环控制周期T、电流控制器参数，初始化转子位置观测变量观测变量

S2、将两相电流采集值和电压输出值代入

计算变量y的导数

S3、将变量y的导数观测变量ab轴电流i_ab(k)代入

计算式中γ＞0为观测器收敛系数；

S4、根据计算代入式计算得出

S5、通过和象限判别，求出转子位置估计值；

S6、根据转子位置估计值的差分求取电机速度估计值代入该值超过预先设置的固定阈值，即该控制周期步进电机失步。