CN110803625B - 一种正面吊工作装置作业姿态自动调整控制方法及系统 - Google Patents

Abstract

本发明提供一种正面吊工作装置作业姿态自动调整控制方法及系统，所述方法包括：在正面吊完成物料收集后，获取正面吊工作装置的姿态初值；并在获取所述姿态初值后实时采集所述正面吊工作装置的姿态测量值；实时计算出正面吊工作装置的姿态测量值与姿态初值的差值，并根据所述差值生成正面吊工作装置的控制信号；根据所述控制信号实时调整正面吊工作装置的姿态，使得正面吊工作装置的姿态变化保持在预设范围内。本发明可根据正面吊行驶路面的变化，实时调整正面吊工作装置的姿态，使得正面吊在行驶过程中保持工作装置角度对路面颠簸的跟随控制，以抵消路面颠簸对工作装置姿态的影响。

Description

一种正面吊工作装置作业姿态自动调整控制方法及系统

技术领域

本发明涉及正面吊控制技术领域，特别是指一种正面吊工作装置作业姿态自动调整控制方法及系统。

背景技术

正面吊是一种集装箱吊运机械，用于港口集装箱的堆垛、装卸、转场、短途运输等场合，其工作装置包括臂架、吊具、驱动油缸和附件等。

正面吊在运输和装车等工况下，由于行驶路面的颠簸不平，导致臂架和吊具随整车一起颠簸，进而导致集装箱的晃动，影响了正面吊的工作效率，也影响正面吊工作安全。

而目前现有技术中并没有一套切实可行的控制方案可以对正面吊的工作装置的姿态进行主动实时控制，以抵消路面颠簸对正面吊臂架和吊具的影响，尤其是抵消路面颠簸对正面吊臂架和吊具角度的影响，从而解决正面吊工作过程中整机、尤其是臂架和吊具随行驶路面一起颠簸的问题。

发明内容

本发明要解决的技术问题是提供一种正面吊工作装置作业姿态自动调整控制方法及系统，解决正面吊工作过程中整机、尤其是臂架和吊具随行驶路面一起颠簸的问题，实现对正面吊的工作装置的姿态进行主动实时控制，以抵消路面颠簸对正面吊臂架和吊具的影响，尤其是抵消路面颠簸对正面吊臂架和吊具角度的影响。

为解决上述技术问题，本发明提供如下技术方案：

一种正面吊工作装置作业姿态自动调整控制方法，包括：

在正面吊带载行驶后，获取正面吊工作装置的姿态初值；并在获取所述姿态初值后实时采集所述正面吊工作装置的姿态测量值；

实时计算出所述正面吊工作装置的姿态测量值与姿态初值的差值，并根据所述差值生成所述正面吊工作装置的控制信号；

根据所述控制信号实时调整所述正面吊工作装置的姿态，使得所述正面吊工作装置的姿态变化保持在预设范围内。

其中，所述获取正面吊工作装置的姿态初值，具体为：

当所述正面吊工作装置的直接或间接驱动油缸没有动作，所述正面吊有行驶或转向动作，且保持预设时间时，获取所述正面吊工作装置的姿态初值。

其中，根据所述差值生成所述正面吊工作装置的控制信号：

S＝C×U(ΔA)；

U(ΔA)＝P×ΔA+D×dΔA/dt；

其中，S表示控制信号，C为预设常数，ΔA表示所述正面吊工作装置的姿态测量值与姿态初值的差值，P、D均为预设控制参数，dΔA/dt为差值变化率，t为获取正面吊工作装置姿态测量值与获取正面吊工作装置姿态初值的时间差。

其中，将所述差值变化率的绝对值与第一预设阈值进行比较；

当所述差值变化率的绝对值不大于第一预设阈值时，按照第三控制方案为P赋值，且D＝0，根据赋值结果计算出U(ΔA)，并根据U(ΔA)计算出控制信号；

当所述差值变化率的绝对值大于第一预设阈值时，所述方法还包括：实时采集所述正面吊的车速测量值；

计算出所述差值与所述正面吊相应时刻的车速测量值的比值，并将所述比值的绝对值与第二预设阈值进行比较；

当所述比值的绝对值大于所述第二预设阈值时，按照第一控制方案为P、D赋值，根据赋值结果计算出U(ΔA)，并根据U(ΔA)计算出控制信号；

当所述比值的绝对值不大于所述第二预设阈值时，按照第二控制方案为P、D赋值，根据赋值结果计算出U(ΔA)，并根据U(ΔA)计算出控制信号。

相应地，为解决上述技术问题，本发明还提供如下技术方案：

一种正面吊工作装置作业姿态自动调整控制系统，包括：

检测模块，用于在正面吊完成物料收集后，获取正面吊工作装置的姿态初值；并在获取所述姿态初值后实时采集所述正面吊工作装置的姿态测量值；

控制模块，用于实时计算出所述正面吊工作装置的姿态测量值与姿态初值的差值，并根据所述差值生成所述正面吊工作装置的控制信号；

执行机构，用于根据所述控制信号实时调整所述正面吊工作装置的姿态，使得所述正面吊工作装置的姿态变化保持在预设范围内。

其中，所述检测模块包括臂架角度传感器或臂架油缸长度传感器

其中，所述控制模块包括集中式控制器、分布式控制器或远程控制器。

其中，所述执行机构包括臂架油缸或动臂油缸。

其中，所述控制模块具体用于：

根据所述差值生成所述正面吊工作装置的控制信号：

S＝C×U(ΔA)；

U(ΔA)＝P×ΔA+D×dΔA/dt；

其中，S表示控制信号，C为预设常数，ΔA表示所述正面吊工作装置的姿态测量值与姿态初值的差值，P、D均为预设控制参数，dΔA/dt为差值变化率，t为获取正面吊工作装置姿态测量值与获取正面吊工作装置姿态初值的时间差。

其中，所述系统还包括车速传感器，所述车速传感器用于实时采集所述正面吊的车速测量值；

所述控制模块还用于：

将所述差值变化率的绝对值与第一预设阈值进行比较；

当所述差值变化率的绝对值不大于第一预设阈值时，按照第一控制方案为P赋值，且D＝0，根据赋值结果计算出U(ΔA)，并根据U(ΔA)计算出控制信号；

当所述差值变化率的绝对值大于第一预设阈值时，计算出所述差值与所述正面吊相应时刻的车速测量值的比值，并将所述比值的绝对值与第二预设阈值进行比较；

当所述比值的绝对值大于所述第二预设阈值时，按照第二控制方案为P、D赋值，根据赋值结果计算出U(ΔA)，并根据U(ΔA)计算出控制信号；

当所述比值的绝对值不大于所述第二预设阈值时，按照第三控制方案为P、D赋值，根据赋值结果计算出U(ΔA)，并根据U(ΔA)计算出控制信号。

本发明的上述技术方案的有益效果如下：

本发明的自动调整控制方法及系统可以根据正面吊行驶路面的变化，实时调整正面吊工作装置的姿态，使得正面吊在行驶过程中保持臂架和吊具角度对路面颠簸的跟随控制。解决了正面吊工作过程中整机、尤其是臂架和吊具随行驶路面一起颠簸的问题，实现了对正面吊的工作装置的姿态进行主动实时控制，抵消了路面颠簸对正面吊臂架和吊具的影响，尤其是抵消了路面颠簸对正面吊臂架和吊具角度的影响。

附图说明

图1为本发明的正面吊工作装置作业姿态自动调整控制方法的流程图；

图2为本发明的正面吊工作装置作业姿态自动调整控制系统的框图；

图3为本发明的正面吊工作装置作业姿态自动调整控制系统的另一框图。

具体实施方式

为使本发明要解决的技术问题、技术方案和优点更加清楚，下面将结合附图及具体实施例进行详细描述。

第一实施例

本实施例提供一种正面吊工作装置作业姿态自动调整控制方法，如图1所示，所述正面吊工作装置作业姿态自动调整控制方法包括：

S1，在正面吊带载行驶后，获取正面吊工作装置的姿态初值A0；并在获取姿态初值A0后实时采集正面吊工作装置的姿态测量值A；

需要说明的是，正面吊工作装置的姿态初值A0的保存条件为：正面吊工作装置的直接或间接驱动油缸没有动作(控制器无输出)，正面吊有行驶或转向动作，且保持预设时间；具体地，在本实施例中，该预设时间为3秒。

正面吊工作装置的姿态可以包括臂架角度或臂架油缸长度；通过采集臂架角度或臂架油缸长度，直接或间接计算得到臂架的姿态，以获得吊具的姿态。

正面吊完成物料收集后开始运输，在运输过程中，臂架和吊具的角度应该保持不变，以防吊具和集装箱晃动。但是正面吊在实际行驶过程中，由于行驶路面不平、上下坡等原因，正面吊整机随路面而颠簸难以避免，而颠簸导致臂架和吊具中的集装箱晃动。实际工作中，正面吊颠簸的主要成分来自于正面吊整机绕垂直于行驶方向上的水平轴线的转动，该转动导致臂架和吊具倾角的变化，进而导致集装箱晃动。因此，在本实施例中主要是获取臂架和吊具的倾角信息。

S2，实时计算出正面吊工作装置的姿态测量值A与姿态初值A0的差值ΔA，并根据姿态测量值与姿态初值的差值ΔA生成正面吊工作装置的控制信号S；

需要说明的是，正面吊在行驶过程中，虽然控制臂架和吊具倾角的所有执行机构都没有动作，但是路面不平导致整机颠簸而改变了臂架和吊具的实际倾角，使得正面吊在行驶过程中的实际倾角与初始倾角出现差值。本实施例方案的目标就是消除臂架和吊具倾角的差值，使得正面吊在行驶过程中，臂架和吊具的实际倾角保持稳定；

具体地，本实施例中的S2包括：

S21，计算出正面吊工作装置的姿态测量值A与姿态初值A0的差值ΔA；

S22，判断dΔA/dt的绝对值是否大于第一预设阈值A1,具体地，本实施例中，A1＝3°；

S23，当dΔA/dt的绝对值不大于A1时，此时对臂架和吊具的影响很小，采用第三套控制参数(P3，D3＝0)，具体地，本实施例中，P3＝1；

此时，U(ΔA)＝P3×ΔA；

S24，当dΔA/dt的绝对值大于A1时，说明此时臂架和吊具的角度偏差已经很明显，需要主动进行控制，而且考虑到在不同行驶速度下，相同的ΔA代表的含义并不相同：同等ΔA下，车速V越低，说明路面颠簸情况越大，对臂架和吊具倾角的影响也越大，因此，需要考虑车速V的影响，进一步执行以下流程：

S25，计算ΔA与正面吊相应时刻的车速测量值V的比值B；并判断B的绝对值是否大于第二预设阈值B1；具体地，本实施例中，B1＝1°·h/km。

S26，当B的绝对值大于B1时，采用第一套控制参数(P1，D1)，具体地，本实施例中，P1＝2，D1＝5；

此时，U(ΔA)＝P1×ΔA+D1×dΔA/dt；

S27,当B的绝对值不大于B1时，按照第二套控制参数(P2，D2)，具体地，本实施例中，P2＝3，D2＝1；

此时，U(ΔA)＝P2×ΔA+D2×dΔA/dt；

S28,根据U(ΔA)，计算出工作装置驱动油缸的电磁阀控制信号S：

S＝C×U(ΔA)；

其中，C为预设常数，具体地，在本实施例中，取C＝1。

S3，根据控制信号实时调整正面吊工作装置的姿态，使得正面吊工作装置的姿态变化保持在预设范围内。

需要说明的是，上述步骤是通过控制信号对臂架和吊具的执行机构(包括臂架油缸和吊具油缸等)进行输出控制，通过对臂架和吊具倾角的主动控制，抵消路面颠簸对臂架和吊具倾角的影响，以此实现臂架和吊具实际倾角在行驶过程中的稳定。

本实施例的自动调整控制方法可以根据正面吊行驶路面的变化，实时调整正面吊工作装置的姿态，使得正面吊在行驶过程中保持臂架和吊具角度对路面颠簸的跟随控制。解决了正面吊工作过程中整机、尤其是臂架和吊具随行驶路面一起颠簸的问题，实现了对正面吊的工作装置的姿态进行主动实时控制，抵消了路面颠簸对正面吊臂架和吊具的影响，尤其是抵消了路面颠簸对正面吊臂架和吊具角度的影响。

第二实施例

本实施例提供一种正面吊工作装置作业姿态自动调整控制系统，如图2所示，所述正面吊工作装置作业姿态自动调整控制系统包括：

检测模块，用于在正面吊带载行驶后，获取正面吊工作装置的姿态初值A0；并在获取A0后实时采集正面吊工作装置的姿态测量值A；

控制模块，用于实时计算出正面吊工作装置的姿态测量值A与姿态初值A0的差值ΔA，并根据ΔA生成正面吊工作装置的控制信号S；

执行机构，用于根据控制信号S实时调整正面吊工作装置的姿态，使得正面吊工作装置的姿态变化保持在预设范围内。

此外，如图3所示，本实施例的正面吊工作装置作业姿态自动调整控制系统还包括车速传感器，所述车速传感器用于实时采集正面吊的车速测量值。

具体地，在本实施例中，上述检测模块为工作装置位置传感器，可以包括臂架角度传感器或臂架长度传感器。通过测量臂架的倾角或臂架驱动油缸的位置，直接或间接计算得到臂架的姿态，以获得吊具的姿态。

正面吊工作装置的姿态初值A0的保存条件为：正面吊工作装置的直接或间接驱动油缸没有动作(控制器没有信号输出)，正面吊有行驶或转向动作，且保持预设时间；具体地，在本实施例中，该预设时间为3秒。

考虑到实际工作中，正面吊颠簸的主要成分来自于正面吊整机绕垂直于行驶方向上的水平轴线的转动，该转动导致臂架和吊具倾角的变化，进而导致集装箱晃动。因此，本实施例采用臂架角度传感器获得臂架的倾角信息，以获得吊具的倾角信息。

控制模块可以包括集中式控制器、分布式控制器或远程控制器，本实施例采用集中式控制器，其具体用于：

计算出正面吊工作装置的姿态测量值A与姿态初值A0的差值ΔA；

判断dΔA/dt的绝对值是否大于第一预设阈值A1，具体地，本实施例中，A1＝3°。

当dΔA/dt的绝对值不大于A1时，此时对臂架和吊具的影响很小，采用第三套控制参数(P3，D3＝0)，具体地，本实施例中，P3＝1；

当dΔA/dt的绝对值大于A1时，说明此时臂架和吊具的角度偏差已经很明显，需要主动进行控制，而且考虑到在不同行驶速度下，相同的ΔA代表的含义并不相同：同等ΔA下，车速V越低，说明路面颠簸情况越大，对臂架和吊具倾角的影响也越大，因此，需要考虑车速V的影响，进一步执行以下流程：

计算ΔA与正面吊相应时刻的车速测量值V的比值B；并判断B的绝对值是否大于第二预设阈值B1；具体地，,本实施例中，B1＝1°·h/km。

当B的绝对值大B1时，采用第一套控制参数((P1，D1)，具体地，本实施例中，P1＝2，D1＝5；

此时，U(ΔA)＝P1×ΔA+D1×dΔA/dt；

当B的绝对值不大于B1时，按照第二套控制参数(P2，D2)，具体地，本实施例中，P2＝3，D2＝1；

此时，U(ΔA)＝P2×ΔA+D2×dΔA/dt；

根据U(ΔA)，计算出工作装置驱动油缸的电磁阀控制信号S：

S＝C×U(ΔA)

其中，C为预设常数，具体地，在本实施例中，取C＝1。

上述执行机构为工作装置驱动油缸，用于直接或间接驱动正面吊臂架或吊具动作，可以包括臂架油缸或动臂油缸等。

本实施例的自动调整控制系统可以根据正面吊行驶路面的变化，实时调整正面吊工作装置的姿态，使得正面吊在行驶过程中保持臂架和吊具角度对路面颠簸的跟随控制。解决了正面吊工作过程中整机、尤其是臂架和吊具随行驶路面一起颠簸的问题，实现了对正面吊的工作装置的姿态进行主动实时控制，抵消了路面颠簸对正面吊臂架和吊具的影响，尤其是抵消了路面颠簸对正面吊臂架和吊具角度的影响。

此外，需要说明的是，在本文中，诸如第一和第二等之类的关系术语仅仅用来将一个实体或者操作与另一个实体或操作区分开来，而不一定要求或者暗示这些实体或操作之间存在任何这种实际的关系或者顺序。

而且，术语“包括”、“包含”或者其任何其他变体意在涵盖非排他性的包含，从而使得包括一系列要素的过程、方法、物品或者终端设备不仅包括那些要素，而且还包括没有明确列出的其他要素，或者是还包括为这种过程、方法、物品或者终端设备所固有的要素。在没有更多限制的情况下，由语句“包括一个……”限定的要素，并不排除在包括所述要素的过程、方法、物品或者终端设备中还存在另外的相同要素。

还需要说明的是，本领域内的技术人员应明白，本发明实施例的实施例可提供为方法、装置或计算机程序产品。而且，本发明实施例可采用在一个或多个其中包含有计算机可用程序代码的计算机可用存储介质(包括但不限于磁盘存储器、CD-ROM、光学存储器等)上实施的计算机程序产品的形式。

本发明实施例是参照根据本发明实施例的方法、终端设备(系统)、和计算机程序产品的流程图和/或方框图来描述的。应理解可由计算机程序指令实现流程图和/或方框图中的每一流程和/或方框、以及流程图和/或方框图中的流程和/或方框的结合。可提供这些计算机程序指令到通用计算机、嵌入式处理机或其他可编程数据处理终端设备的处理器以产生一个机器，使得通过计算机或其他可编程数据处理终端设备的处理器执行的指令产生用于实现在流程图一个流程或多个流程和/或方框图一个方框或多个方框中指定的功能的装置。

这些计算机程序指令也可存储在能引导计算机或其他可编程数据处理终端设备以特定方式工作的计算机可读存储器中，使得存储在该计算机可读存储器中的指令产生包括指令装置的制造品，该指令装置实现在流程图一个流程或多个流程和/或方框图一个方框或多个方框中指定的功能。这些计算机程序指令也可装载到计算机或其他可编程数据处理终端设备上，使得在计算机或其他可编程终端设备上执行一系列操作步骤以产生计算机实现的处理，从而在计算机或其他可编程终端设备上执行的指令提供用于实现在流程图一个流程或多个流程和/或方框图一个方框或多个方框中指定的功能的步骤。

以上所述是本发明的优选实施方式，应当指出，尽管已描述了本发明的优选实施例，但对于本技术领域的普通技术人员来说，一旦得知了本发明的基本创造性概念，在不脱离本发明所述原理的前提下，还可以做出若干改进和润饰，这些改进和润饰也应视为本发明的保护范围。所以，所附权利要求意欲解释为包括优选实施例以及落入本发明实施例范围的所有变更和修改。

Claims (6)

1.一种正面吊工作装置作业姿态自动调整控制方法，其特征在于，包括：

在正面吊完成物料收集后，获取正面吊工作装置的姿态初值；并在获取所述姿态初值后实时采集所述正面吊工作装置的姿态测量值；

实时计算出所述正面吊工作装置的姿态测量值与姿态初值的差值变化率，并根据所述差值变化率生成所述正面吊工作装置的控制信号；

根据所述控制信号实时调整所述正面吊工作装置的姿态，使得所述正面吊工作装置的姿态变化保持在预设范围内；

根据所述差值生成所述正面吊工作装置的控制信号：

S＝C×U(ΔA)；

U(ΔA)＝P×ΔA+D×dΔA/dt；

其中，S表示控制信号，C为预设常数，ΔA表示所述正面吊工作装置的姿态测量值与姿态初值的差值，P、D均为预设控制参数，dΔA/dt为差值变化率，t为获取正面吊工作装置姿态测量值与获取正面吊工作装置姿态初值的时间差；

将所述差值变化率的绝对值与第一预设阈值进行比较；

当所述差值变化率的绝对值不大于第一预设阈值时，按照第三控制方案为P赋值，且D＝0，根据赋值结果计算出U(ΔA)，并根据U(ΔA)计算出控制信号；

当所述差值变化率的绝对值大于第一预设阈值时，所述方法还包括：实时采集所述正面吊的车速测量值；

计算出所述差值与所述正面吊相应时刻的车速测量值的比值，并将所述比值的绝对值与第二预设阈值进行比较；

当所述比值的绝对值大于所述第二预设阈值时，按照第一控制方案为P、D赋值，根据赋值结果计算出U(ΔA)，并根据U(ΔA)计算出控制信号；

当所述比值的绝对值不大于所述第二预设阈值时，按照第二控制方案为P、D赋值，根据赋值结果计算出U(ΔA)，并根据U(ΔA)计算出控制信号。

2.如权利要求1所述的正面吊工作装置作业姿态自动调整控制方法，其特征在于，所述获取正面吊工作装置的姿态初值，具体为：

当所述正面吊工作装置的直接或间接驱动油缸没有动作，所述正面吊有行驶或转向动作，且保持预设时间时，获取所述正面吊工作装置的姿态初值。

3.一种正面吊工作装置作业姿态自动调整控制系统，其特征在于，包括：

检测模块，用于在正面吊完成物料收集后，获取正面吊工作装置的姿态初值；并在获取所述姿态初值后实时采集所述正面吊工作装置的姿态测量值；

控制模块，用于实时计算出所述正面吊工作装置的姿态测量值与姿态初值的差值，并根据所述差值生成所述正面吊工作装置的控制信号；

执行机构，用于根据所述控制信号实时调整所述正面吊工作装置的姿态，使得所述正面吊工作装置的姿态变化保持在预设范围内；

所述系统还包括车速传感器，所述车速传感器用于实时采集所述正面吊的车速测量值；所述控制模块具体用于：

根据所述差值生成所述正面吊工作装置的控制信号：

S＝C×U(ΔA)；

U(ΔA)＝P×ΔA+D×dΔA/dt：

其中，S表示控制信号，C为预设常数，ΔA表示所述正面吊工作装置的姿态测量值与姿态初值的差值，P、D均为预设控制参数，dΔA/dt为差值变化率，t为获取正面吊工作装置姿态测量值与获取正面吊工作装置姿态初值的时间差；

将所述差值变化率的绝对值与第一预设阈值进行比较；

当所述差值变化率的绝对值不大于第一预设阈值时，按照第三控制方案为P赋值，且D＝0，根据赋值结果计算出U(ΔA)，并根据U(ΔA)计算出控制信号；

当所述差值变化率的绝对值大于第一预设阈值时，计算出所述差值与所述正面吊相应时刻的车速测量值的比值，并将所述比值的绝对值与第二预设阈值进行比较；

当所述比值的绝对值大于所述第二预设阈值时，按照第一控制方案为P、D赋值，根据赋值结果计算出U(ΔA)，并根据U(ΔA)计算出控制信号；

当所述比值的绝对值不大于所述第二预设阈值时，按照第二控制方案为P、D赋值，根据赋值结果计算出U(ΔA)，并根据U(ΔA)计算出控制信号。

4.如权利要求3所述的正面吊工作装置作业姿态自动调整控制系统，其特征在于，所述检测模块包括臂架角度传感器或臂架油缸长度传感器。

5.如权利要求3所述的正面吊工作装置作业姿态自动调整控制系统，其特征在于，所述控制模块包括集中式控制器、分布式控制器或远程控制器。

6.如权利要求3所述的正面吊工作装置作业姿态自动调整控制系统，其特征在于，所述执行机构包括臂架油缸或动臂油缸。

Images