[发明专利]步进电机运动系统自检回零的方法

摘要

本发明提供一种步进电机运动系统自检回零的方法，步进电机运动系统自检回零的方法，是指步进电机从任意回零起始位置Pr出发，通过慢速与快速相互结合与切换，且只朝一个方向运动找到全局零点P0，在找到全局零点P0后，并校正到真零点Pa，完成自检回零的方法。本发明提供的自检回零方法能减少步进电机运动系统自检回零过程的时间和碰撞以及调试，实现步进电机运动系统快速可靠地自检回零，自检回零过程快速可靠；而且能有效降低回零过程中产生地噪音；而且能简化调试过程和调试程序并且能帮助诊断步进电机硬件与结构上可能发生的故障。

主权项

1.步进电机运动系统自检回零的方法，其特征在于，是指步进电机从任意回零起始位置Pr出发，通过慢速与快速相互结合与切换，且只朝一个方向运动找到全局零点P0，并校正到真零点Pa，完成自检回零的方法；具体步骤如下：(1)步进电机从任意回零起始位置Pr出发朝全局零点P0的方向运动；(2)运动过程中，当以较慢速度Vs匀速朝全局零点P0方向运动，其慢速运动距离超过真零点Pa到全局零点P0的距离则加速；运动过程中，当以较快速度Vq匀速朝全局零点P0方向运动，检测到真零点Pa或伪零点Pa’减速信号则减速；(3)通过步骤(2)中较慢速度Vs与较快速度Vq的相互结合与切换，朝一个方向以较慢速度Vs和较快速度Vq循环交替运动，直至找到全局零点P0，即止位挡杆的位置，步进电机紧急停止，且步进电机总是以较慢速度Vs紧急停止；(4)找到全局零点P0后，以较慢速度Vs校正到真零点Pa，自检回零结束；步骤(2)中较快速度Vq选取的依据是当步进电机检测到真零点Pa或伪零点Pa’减速信号而减速的减速距离不会超过真零点Pa到全局零点P0的距离；步骤(2)中较慢速度Vs选取的依据是步进电机找到全局零点P0紧急停止时不会过冲而发生严重碰撞。