[发明专利]一种消除步进电机累计误差的系统及其控制方法

摘要

本发明公开了一种消除步进电机累计误差的系统及其控制方法，其中，系统包括一步进电机，所述步进电机输出端连接丝杆传动机构，所述丝杆传动机构连接摄像部并带动摄像部往返运动进行对焦，还包括至少一组确定电机位置的光耦开关组，所述摄像部上还设置有触发光耦开关组的挡片，采用本发明可解决现有技术的步进电机因失步或回程差导致工作时行程误差不断累积，没有外部反馈难以纠正误差的技术问题。

主权项

一种消除步进电机累计误差的控制方法，其特征在于，包括以下步骤：步骤a：步进电机复位：步进电机上电，步进电机带动摄像部向0号光耦开关行进，挡片触到0号光耦开关后反向运行一定距离后停止，该位置标定为复位原点；步骤b：对各光耦开关进行位置标定：步进电机运行带动摄像部按顺序触发0号光耦开关至7号光耦开关，每触发一个光耦开关单片机产生中断，通过串口输出当前步进电机相对于复位原点的位置，步进电机往返多次得出多组位置数据，求其平均值得到每个光耦开关相对复位原点的绝对位置；步骤c：纠正步进电机计步位置：将每个光耦开关的绝对位置和光耦开关的编号对应起来并保存于单片机中，摄像部进行对焦往返运行时，挡片每触发一个光耦开光，单片机比较当前计步位置和所触发光耦开关对应的绝对位置的差值，如果在设定范围内，不对计步位置做修改；如超出设定范围，用所触发光耦开关对应的绝对位置替换当前计步位置；步骤d：新的复位过程：步进电机上电后带动摄像部就近寻找一光耦开关以确定当前步进电机的位置，位置确定后步进电机停止，复位成功。