[发明专利]一种步进电机控制系统及其控制方法

说明书

本发明公开了一种步进电机控制系统，包括主控制单元、执行单元、步进电机驱动单元、步进电机、传动组件、负载组件、光耦挡片和光耦，其中，还包括从控制单元；所述从控制单元与主控制单元和执行单元相连接，所述执行单元连接步进电机驱动单元，所述步进电机驱动单元连接传动组件，所述传动组件连接负载，所述光耦挡片固定在负载组件上，所述光耦固定设置在步进电机指定到达位置处；所述光耦连接执行单元，回传状态数据给执行单元。本发明通过采用从控制单元，实时地监控执行单元；在步进电机运动步数变为0的时候，从控制单元能查询光耦的状态以判断是否需要发出步进电机丢步补偿动作命令，从而解决步进电机运动不到位的问题。

技术领域

本发明属于电机控制技术领域，具体涉及一种步进电机控制系统及其控制方法。

背景技术

步进电机因所走角度与输入脉冲数成正比，被广泛应用在仪器设备中。实际应用中，步进电机在走位置时，由于结构上的不可避免的传动组件回程差或电机本身回程差或生产加工误差或轻微的步进电机失步，通常在步进电机走理论上的固定步数后，并不能到达预定的目标位置,这一现象统称步进电机丢步。步进电机通过传动组件带动负载从A位置移动到B位置，通常有下面三种方式解决丢步问题：

方式一：对于位置精度要求不高的场合，通过走固定的步数实现。例如已有专利CN201210422712.3-一种步进电机的控制系统及控制方法就是这样使用的。

方式二：在位置B处安装位置开关或位置光耦，一直让步进电机运动，直到位置开关或位置光耦生效。例如已有专利CN201210370374.3-步进电机驱动的控制系统中限位开关信号的处理方法中介绍的就是这种方法。

方式三：在方式一的基础上在位置A和位置B上安装位置开关或位置光耦，电机走固定步数后判断位置开关或位置光耦是否生效，软件通过判断是否生效来判断运动是否到位。例如专利CN200910065327.6-一种步进电机控制系统及其控制方法中就用到这种方法。

上述方式存在的问题有：现有解决丢步问题的技术方案在检验检疫产品中不适用，导致检验检疫产品中步进电机运动不到位。

因而，现有技术还有待改进。

发明内容

鉴于上述现有技术的不足，本发明的目的在于提供一种步进电机控制系统及其控制方法，能解决检验检疫产品中电机运动不到位的问题。

为了达到上述目的，本发明采取了以下技术方案：

一种步进电机控制系统，包括主控制单元、执行单元、步进电机驱动单元、步进电机、传动组件、负载组件、光耦挡片和光耦，其中，还包括从控制单元；所述从控制单元与主控制单元和执行单元相连接；所述执行单元连接步进电机驱动单元，所述步进电机驱动单元连接传动组件，所述传动组件连接负载，所述光耦挡片固定在负载组件上，所述光耦固定设置在步进电机指定到达位置处；所述光耦连接执行单元，回传状态数据给执行单元，所述从控制单元用于解析主控制单元下发的指令、向执行单元下发电机动作命令、监控执行单元的执行、查询光耦状态并判断是否需要执行单元发出步进电机丢步补偿动作命令。

所述步进电机控制系统，其中，所述从控制单元更具体的控制流程为：解析主控制单元下发的指令，并向执行单元下发电机动作命令，所述主控制单元下发的指令具体包含步进电机的运动方向和运动步数，所述步进电机驱动单元设置有驱动计步器，在驱动电机运动时，步进电机每运动一步，计步器的步数减1，直到计步器的步数减为0时，控制步进电机停止运动；同时通过执行单元监控步进电机的运动指令是否运行结束，是则判断光耦是否被遮挡，如果被遮挡则停止步进电机运动，如果没有被遮挡则向执行单元下发电机丢步补偿动作命令，并实时监控补偿动作是否完成，完成则向执行单元下发光耦对齐动作命令；最后监控光耦对齐动作是否完成，如果完成则上报主控控制单元电机位置动作完成。

一种步进电机控制系统的控制方法，其特征在于：包括以下步骤：

步骤a：主控制单元下发指令给从控制单元；