[发明专利]起重机精确自动定位控制系统及方法

说明书

技术领域

本发明属于运行机械的定位自动控制技术领域，涉及一种起重机精确自动定位控制系统及方法。

背景技术

因生产工艺需要，各种工业用起重机常要求具有精确自动定位控制功能。 目前起重机的精确自动定位控制一般采用伺服控制的方案。 如图1所示，伺服控制系统需要由主令控制器11，伺服控制器12，放大驱动器13，伺服电机14，执行机构15，位置传感器16，等组成。在伺服控制系统中，每个时刻都要产生机械运行机构的目标位置。 在机械运行机构的运行过程中，伺服控制器每时每刻根据目标位置和实际位置的测量反馈进行调整控制。 为保证机械运行机构在运行过程中每时每刻都在指定的目标位置上，伺服控制系统中实际位置的测量反馈及对伺服电机的控制一般需要高达500 Hz以上的控制更新频率。 各种精密机床的运动控制是典型的伺服控制的应用例子。 

然而，在定位控制的许多实际工业应用中，如轨道机车，多层电梯，起重机等，我们只要求机械运行机构在运行后的停止位置上实现精确自动定位，而在运行过程中，除了运行速度的平滑稳定，对机械运行机构的动态位置精度没有太高的要求。 在这些应用中，许多控制系统的位置测量反馈和控制更新频率比伺服系统的控制更新频率要低得多。 例如，用可编程控制器（PLC）作为反馈控制时，可编程控制器的控制更新频率一般在50 Hz以下，远远低于伺服系统的控制更新频率。

由于伺服控制系统复杂，价格昂贵，在许多自动定位控制应用中，特别是起重机的精确自动定位，希望有更经济合理的精确定位控制系统替代伺服控制系统。

发明内容

本发明的目的是提供一种起重机精确自动定位控制系统和控制方法，以解决现有起重机的定位控制中伺服控制系统复杂，对控制器及电机精密度要求高的问题。

为实现上述目的，本发明一种起重机精确自动定位控制系统，包括顺次控制连接的主令控制器、可编程控制器、变频器、电机和执行机构，该执行机构上设有位置传感器，该位置传感器的输出连入所述可编程控制器的信号输入端，用于反馈执行机构的位置信号。

本发明的起重机精确自动定位控制方法，利用可编程控制器作为起重机执行机构的位置反馈控制器，根据系统更新周期、目标停止位置和执行机构当前位置信息，计算得到当前减速度和该周期的目标控制速度，并在下一周期重新计算减速度和目标控制速度，直到控制执行机构精确地到达指定的目标停止位置。

进一步的，所述控制方法的具体步骤如下：

（1）主令控制器向可编程控制器发送执行机构的目标停止位置信息；

（2）可编程控制器接收主令控制器发送的执行机构的目标停止位置信息和位置传感器反馈的执行机构实际运行位置；

（3）可编程控制器根据目标位置和实际运行位置计算得到执行机构离目标停止位置的距离，并计算出执行机构的减速度；

（4）可编程控制器根据更新周期和运行机构的减速度得到运行机构的目标控制速度；并将该目标控制速度传给变频器；

（5）变频器和电机驱动执行机构，使执行机构精确地到达指定的目标停止位置。

进一步的，所述步骤（3）中执行机构的减速度A的计算公式为A=KV²/D ，其中V为执行机构的当前运行速度，D为执行机构当前位置离目标位置的距离，K为调整系数。

进一步的，所述调整系数K的范围为                                                。

进一步的，所述步骤（4）中执行机构目标控制速度V_n的计算公式为：V_n=V_n-1-A·T，其中V_n-1 为可编程控制器在上一次控制更新时计算得到的运行机构的目标速度，T为可编程控制器的控制更新周期。

本发明的起重机精确自动定位控制系统和控制方法，用可编程控制器作为反馈控制时，不需要生成执行机构在运行过程中动态的目标位置，可编程控制器根据目标停止位置和反馈的执行机构位置信息，直接计算出执行机构的实时目标速度，并通过变频器和电机的驱动，控制执行机构精确地到达指定的目标停止位置。系统中所用电机为普通电机，且系统对可编程控制器的更新频率要求不高，整个系统结构简单，价格也更经济合理。

附图说明

图1是现有的伺服控制系统原理图；

图2是本发明精确自动定位控制系统实施例原理图；

图3是运行机构目标速度随时间变化的示意图。

具体实施方式