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

权利要求书

1.一种消除步进电机累计误差的控制方法，其特征在于，包括以下步骤：

步骤a：步进电机复位：步进电机上电，步进电机带动摄像部向0号光耦开关行进，挡片触到0号光耦开关后反向运行一定距离后停止，该位置标定为复位原点；

步骤b：对各光耦开关进行位置标定：步进电机运行带动摄像部按顺序触发0号光耦开关至7号光耦开关，每触发一个光耦开关单片机产生中断，通过串口输出当前步进电机相对于复位原点的位置，步进电机往返多次得出多组位置数据，求其平均值得到每个光耦开关相对复位原点的绝对位置；

步骤c：纠正步进电机计步位置：将每个光耦开关的绝对位置和光耦开关的编号对应起来并保存于单片机中，摄像部进行对焦往返运行时，挡片每触发一个光耦开光，单片机比较当前计步位置和所触发光耦开关对应的绝对位置的差值，如果在设定范围内，不对计步位置做修改；如超出设定范围，用所触发光耦开关对应的绝对位置替换当前计步位置；

步骤d：新的复位过程：步进电机上电后带动摄像部就近寻找一光耦开关以确定当前步进电机的位置，位置确定后步进电机停止，复位成功。

2.根据权利要求1所述的消除步进电机累计误差的控制方法，其特征在于，在步骤a中，步进电机带动摄像部向0号光耦开关行进的过程中，1号光耦开关至7号光耦开关对应的中断被屏蔽。

3.根据权利要求1所述的消除步进电机累计误差的控制方法，其特征在于，在步骤a中，挡片触到0号光耦开关后反向运行至工作行程的中点后停止。