CN110775890A - 一种堆高机工作装置作业姿态自动调整控制方法及系统 - Google Patents
一种堆高机工作装置作业姿态自动调整控制方法及系统 Download PDFInfo
- Publication number
- CN110775890A CN110775890A CN201911223839.0A CN201911223839A CN110775890A CN 110775890 A CN110775890 A CN 110775890A CN 201911223839 A CN201911223839 A CN 201911223839A CN 110775890 A CN110775890 A CN 110775890A
- Authority
- CN
- China
- Prior art keywords
- value
- working device
- forklift
- attitude
- posture
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B66—HOISTING; LIFTING; HAULING
- B66F—HOISTING, LIFTING, HAULING OR PUSHING, NOT OTHERWISE PROVIDED FOR, e.g. DEVICES WHICH APPLY A LIFTING OR PUSHING FORCE DIRECTLY TO THE SURFACE OF A LOAD
- B66F9/00—Devices for lifting or lowering bulky or heavy goods for loading or unloading purposes
- B66F9/06—Devices for lifting or lowering bulky or heavy goods for loading or unloading purposes movable, with their loads, on wheels or the like, e.g. fork-lift trucks
- B66F9/075—Constructional features or details
- B66F9/07559—Stabilizing means
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B66—HOISTING; LIFTING; HAULING
- B66F—HOISTING, LIFTING, HAULING OR PUSHING, NOT OTHERWISE PROVIDED FOR, e.g. DEVICES WHICH APPLY A LIFTING OR PUSHING FORCE DIRECTLY TO THE SURFACE OF A LOAD
- B66F9/00—Devices for lifting or lowering bulky or heavy goods for loading or unloading purposes
- B66F9/06—Devices for lifting or lowering bulky or heavy goods for loading or unloading purposes movable, with their loads, on wheels or the like, e.g. fork-lift trucks
- B66F9/075—Constructional features or details
- B66F9/07581—Remote controls
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B66—HOISTING; LIFTING; HAULING
- B66F—HOISTING, LIFTING, HAULING OR PUSHING, NOT OTHERWISE PROVIDED FOR, e.g. DEVICES WHICH APPLY A LIFTING OR PUSHING FORCE DIRECTLY TO THE SURFACE OF A LOAD
- B66F9/00—Devices for lifting or lowering bulky or heavy goods for loading or unloading purposes
- B66F9/06—Devices for lifting or lowering bulky or heavy goods for loading or unloading purposes movable, with their loads, on wheels or the like, e.g. fork-lift trucks
- B66F9/075—Constructional features or details
- B66F9/20—Means for actuating or controlling masts, platforms, or forks
- B66F9/22—Hydraulic devices or systems
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B66—HOISTING; LIFTING; HAULING
- B66F—HOISTING, LIFTING, HAULING OR PUSHING, NOT OTHERWISE PROVIDED FOR, e.g. DEVICES WHICH APPLY A LIFTING OR PUSHING FORCE DIRECTLY TO THE SURFACE OF A LOAD
- B66F9/00—Devices for lifting or lowering bulky or heavy goods for loading or unloading purposes
- B66F9/06—Devices for lifting or lowering bulky or heavy goods for loading or unloading purposes movable, with their loads, on wheels or the like, e.g. fork-lift trucks
- B66F9/075—Constructional features or details
- B66F9/20—Means for actuating or controlling masts, platforms, or forks
- B66F9/24—Electrical devices or systems
Landscapes
- Engineering & Computer Science (AREA)
- Transportation (AREA)
- Structural Engineering (AREA)
- Civil Engineering (AREA)
- Life Sciences & Earth Sciences (AREA)
- Geology (AREA)
- Mechanical Engineering (AREA)
- Chemical & Material Sciences (AREA)
- Combustion & Propulsion (AREA)
- Forklifts And Lifting Vehicles (AREA)
Abstract
本发明提供一种堆高机工作装置作业姿态自动调整控制方法及系统,所述方法包括:在堆高机带载行驶后,获取堆高机工作装置的姿态初值;并在获取所述姿态初值后实时采集所述堆高机工作装置的姿态测量值;实时计算出所述堆高机工作装置的姿态测量值与姿态初值的差值,根据所述差值生成所述堆高机工作装置的控制信号;根据所述控制信号实时调整所述堆高机工作装置的姿态,使得所述堆高机工作装置的姿态变化保持在预设范围内。本发明可根据堆高机行驶路面的变化,实时调整堆高机工作装置的姿态,使得堆高机在行驶过程中保持工作装置角度对路面颠簸的跟随控制,以抵消路面颠簸对工作装置姿态的影响。
Description
技术领域
本发明涉及堆高机控制技术领域,特别是指一种堆高机工作装置作业姿态自动调整控制方法及系统。
背景技术
堆高机是一种集装箱空箱作业机械,用于港口和码头的集装箱空箱的堆垛、短途运输、装卸、转场等场合,其工作装置包括门架、驱动油缸和附件等。
堆高机在运输和装车等工况下,由于行驶路面的颠簸不平,导致门架和吊具随整车一起颠簸,进而导致门架和吊具中的集装箱晃动,影响了堆高机的工作效率,也影响堆高机工作安全。
而目前现有技术中并没有一套切实可行的控制方案可以对堆高机的工作装置的姿态进行主动实时控制,以抵消路面颠簸对堆高机门架和吊具的影响,尤其是抵消路面颠簸对堆高机门架和吊具角度的影响,从而解决堆高机工作过程中整机、尤其是门架和吊具随行驶路面一起颠簸的问题。
发明内容
本发明要解决的技术问题是提供一种堆高机工作装置作业姿态自动调整控制方法及系统,解决堆高机工作过程中整机、尤其是门架和吊具随行驶路面一起颠簸的问题,实现对堆高机的工作装置的姿态进行主动实时控制,以抵消路面颠簸对堆高机门架和吊具的影响,尤其是抵消路面颠簸对堆高机门架和吊具角度的影响。
为解决上述技术问题,本发明提供如下技术方案:
一种堆高机工作装置作业姿态自动调整控制方法,包括:
在堆高机带载行驶后,获取堆高机工作装置的姿态初值;并在获取所述姿态初值后实时采集所述堆高机工作装置的姿态测量值;
实时计算出所述堆高机工作装置的姿态测量值与姿态初值的差值,根据所述差值生成所述堆高机工作装置的控制信号;
根据所述控制信号实时调整所述堆高机工作装置的姿态,使得所述堆高机工作装置的姿态变化保持在预设范围内。
其中,所述获取堆高机工作装置的姿态初值,具体为:
当所述堆高机工作装置的直接或间接驱动油缸没有动作,所述堆高机有行驶或转向动作,且保持预设时间时,获取所述堆高机工作装置的姿态初值。
其中,根据所述差值所述堆高机工作装置的控制信号:
S=C×U(ΔA);
U(ΔA)=P×ΔA+I×∫ΔAdt;
其中,S表示控制信号,C为预设常数,ΔA表示所述堆高机工作装置的姿态测量值与姿态初值的差值,P、I均为预设控制参数,t为获取堆高机工作装置姿态测量值与获取堆高机工作装置姿态初值的时间差,∫ΔAdt为差值在时间域上的积分。
其中,将∫ΔAdt的绝对值与第一预设阈值进行比较;
当∫ΔAdt的绝对值不大于第一预设阈值时,按照第三控制方案为P赋值,且I=0,根据赋值结果计算出U(ΔA),并根据U(ΔA)计算出控制信号;
当∫ΔAdt的绝对值大于所述第一预设阈值时,所述方法还包括:实时采集所述堆高机的车速测量值;
计算出所述差值与所述堆高机相应时刻的车速测量值的比值,并将所述比值的绝对值与第二预设阈值进行比较;
当所述比值的绝对值大于所述第二预设阈值时,按照第一控制方案为P、I赋值,根据赋值结果计算出U(ΔA),并根据U(ΔA)计算出控制信号;
当所述比值的绝对值不大于所述第二预设阈值时,按照第二控制方案为P、I赋值,根据赋值结果计算出U(ΔA),并根据U(ΔA)计算出控制信号。
相应地,为解决上述技术问题,本发明还提供如下技术方案:
一种堆高机工作装置作业姿态自动调整控制系统,包括:
检测模块,用于在堆高机带载行驶后,获取堆高机工作装置的姿态初值;并在获取所述姿态初值后实时采集所述堆高机工作装置的姿态测量值;
控制模块,用于实时计算出所述堆高机工作装置的姿态测量值与姿态初值的差值,根据所述差值生成所述堆高机工作装置的控制信号;
执行机构,用于根据所述控制信号实时调整所述堆高机工作装置的姿态,使得所述堆高机工作装置的姿态变化保持在预设范围内。
其中,所述检测模块包括门架角度传感器或门架油缸长度传感器。
其中,所述控制模块包括集中式控制器、分布式控制器或远程控制器。
其中,所述执行机构包括门架油缸或动臂油缸。
其中,所述控制模块具体用于:
根据所述差值生成所述堆高机工作装置的控制信号:
S=C×U(ΔA);
U(ΔA)=P×ΔA+I×∫ΔAdt;
其中,S表示控制信号,C为预设常数,ΔA表示所述堆高机工作装置的姿态测量值与姿态初值的差值,P、I均为预设控制参数,t为获取堆高机工作装置姿态测量值与获取堆高机工作装置姿态初值的时间差,∫ΔAdt为差值在时间域上的积分。
其中,所述系统还包括车速传感器,所述车速传感器用于实时采集所述堆高机的车速测量值;
所述控制模块还用于:
将∫ΔAdt的绝对值与第一预设阈值进行比较;
当∫ΔAdt的绝对值不大于第一预设阈值时,按照第三控制方案为P赋值,且I=0,根据赋值结果计算出U(ΔA),并根据U(ΔA)计算出控制信号;
当∫ΔAdt的绝对值大于所述第一预设阈值时,计算出所述差值与所述堆高机相应时刻的车速测量值的比值,并将所述比值的绝对值与第二预设阈值进行比较;
当所述比值的绝对值大于所述第二预设阈值时,按照第一控制方案为P、I赋值,根据赋值结果计算出U(ΔA),并根据U(ΔA)计算出控制信号;
当所述比值的绝对值不大于所述第二预设阈值时,按照第二控制方案为P、I赋值,根据赋值结果计算出U(ΔA),并根据U(ΔA)计算出控制信号。
本发明的上述技术方案的有益效果如下:
本发明的自动调整控制方法及系统可以根据堆高机行驶路面的变化,实时调整堆高机工作装置的姿态,使得堆高机在行驶过程中保持门架和吊具角度对路面颠簸的跟随控制。解决了堆高机工作过程中整机、尤其是门架和吊具随行驶路面一起颠簸的问题,实现了对堆高机的工作装置的姿态进行主动实时控制,抵消了路面颠簸对堆高机门架和吊具的影响,尤其是抵消了路面颠簸对堆高机门架和吊具角度的影响。
附图说明
图1为本发明的堆高机工作装置作业姿态自动调整控制方法的流程图;
图2为本发明的堆高机工作装置作业姿态自动调整控制系统的框图;
图3为本发明的堆高机工作装置作业姿态自动调整控制系统的另一框图。
具体实施方式
为使本发明要解决的技术问题、技术方案和优点更加清楚,下面将结合附图及具体实施例进行详细描述。
第一实施例
本实施例提供一种堆高机工作装置作业姿态自动调整控制方法,如图1所示,所述堆高机工作装置作业姿态自动调整控制方法包括:
S1,在堆高机带载行驶后,获取堆高机工作装置的姿态初值A0;并在获取姿态初值A0后实时采集堆高机工作装置的姿态测量值A;
需要说明的是,堆高机工作装置的姿态初值A0的保存条件为:堆高机工作装置的直接或间接驱动油缸没有动作(控制器无输出),堆高机有行驶或转向动作,且保持预设时间;具体地,在本实施例中,该预设时间为3秒。
堆高机工作装置的姿态可以包括门架角度或门架油缸长度;通过采集门架角度或门架油缸长度,直接或间接计算得到门架的姿态,以获得吊具的姿态。
堆高机带载行驶后开始运输,在运输过程中,门架和吊具的角度应该保持不变,以防门架和吊具中的集装箱晃动。但是堆高机在实际行驶过程中,由于行驶路面不平、上下坡等原因,堆高机整机随路面而颠簸难以避免,而颠簸导致门架和吊具中的集装箱晃动。实际工作中,堆高机颠簸的主要成分来自于堆高机整机绕垂直于行驶方向上的水平轴线的转动,该转动导致门架和吊具倾角的变化,进而导致集装箱晃动。因此,在本实施例中主要是获取门架和吊具的倾角信息。
S2,实时计算出堆高机工作装置的姿态测量值A与姿态初值A0的差值ΔA,根据ΔA生成所述堆高机工作装置的控制信号。
需要说明的是,堆高机在行驶过程中,虽然控制门架和吊具倾角的所有执行机构都没有动作,但是路面不平导致整机颠簸而改变了门架和吊具的实际倾角,使得堆高机在行驶过程中的实际倾角与初始倾角出现差值。本实施例方案的目标就是消除门架和吊具倾角的差值,使得堆高机在行驶过程中,门架和吊具的实际倾角保持稳定;
具体地,本实施例中的S2包括:
S21,计算出堆高机工作装置的姿态测量值A与姿态初值A0的差值ΔA;
S22,判断∫ΔAdt的绝对值是否大于第一预设阈值A1,具体地,本实施例中,A1=3°;
S23,当∫ΔAdt的绝对值不大于A1时,采用第一套控制参数(P3,I3=0),具体地,本实施例中,P3=1;
S24,当∫ΔAdt的绝对值大于A1时,说明此时门架和吊具的角度偏差已经很明显,需要主动进行控制,而且考虑到在不同行驶速度下,相同的ΔA代表的含义并不相同:同等ΔA下,车速V越低,说明路面颠簸情况越大,对门架和吊具倾角的影响也越大,因此,需要考虑车速V的影响,进一步执行以下流程:
S25,计算ΔA与堆高机相应时刻的车速测量值V的比值B;并判断B的绝对值是否大于第二预设阈值B1;具体地,本实施例中,B1=1°km/h。
S26,当B的绝对值大于B1时,采用第一套控制参数(P1,I1),具体地,本实施例中,P1=2,I1=1,;
此时,U(ΔA)=P1×ΔA+I1×∫ΔAdt;
S27,当B的绝对值不大于B1时,按照第二套控制参数(P2,I2),具体地,本实施例中,P2=3,I2=0.51;
此时,U(ΔA)=P2×ΔA+I2×∫ΔAdt;
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;
判断∫ΔAdt的绝对值是否大于第一预设阈值A1,具体地,本实施例中,A1=3°;
当∫ΔAdt的绝对值不大于A1时,采用第一套控制参数(P3,I3=0),具体地,本实施例中,P3=1;
当∫ΔAdt的绝对值大于A1时,说明此时门架和吊具的角度偏差已经很明显,需要主动进行控制,而且考虑到在不同行驶速度下,相同的ΔA代表的含义并不相同:同等ΔA下,车速V越低,说明路面颠簸情况越大,对门架和吊具倾角的影响也越大,因此,需要考虑车速V的影响,进一步执行以下流程:
计算ΔA与堆高机相应时刻的车速测量值V的比值B;并判断B的绝对值是否大于第二预设阈值B1;具体地,本实施例中,B1=1°km/h。
当B的绝对值大于B1时,采用第一套控制参数(P1,I1),具体地,本实施例中,P1=2,I1=1,;
此时,U(ΔA)=P1×ΔA+I1×∫ΔAdt;
当B的绝对值不大于B1时,按照第二套控制参数(P2,I2),具体地,本实施例中,P2=3,I2=0.51;
此时,U(ΔA)=P2×ΔA+I2×∫ΔAdt;
根据U(ΔA),计算出工作装置驱动油缸的电磁阀控制信号S:
S=C×U(ΔA)
其中,C为预设常数,具体地,在本实施例中,取C=1。
上述执行机构为工作装置驱动油缸,用于直接或间接驱动堆高机门架和吊具动作,可以包括门架油缸、动臂油缸等。
本实施例的自动调整控制系统可以根据堆高机行驶路面的变化,实时调整堆高机工作装置的姿态,使得堆高机在行驶过程中保持门架和吊具角度对路面颠簸的跟随控制。解决了堆高机工作过程中整机、尤其是门架和吊具随行驶路面一起颠簸的问题,实现了对堆高机的工作装置的姿态进行主动实时控制,抵消了路面颠簸对堆高机门架和吊具的影响,尤其是抵消了路面颠簸对堆高机门架和吊具角度的影响。
此外,需要说明的是,在本文中,诸如第一和第二等之类的关系术语仅仅用来将一个实体或者操作与另一个实体或操作区分开来,而不一定要求或者暗示这些实体或操作之间存在任何这种实际的关系或者顺序。
而且,术语“包括”、“包含”或者其任何其他变体意在涵盖非排他性的包含,从而使得包括一系列要素的过程、方法、物品或者终端设备不仅包括那些要素,而且还包括没有明确列出的其他要素,或者是还包括为这种过程、方法、物品或者终端设备所固有的要素。在没有更多限制的情况下,由语句“包括一个……”限定的要素,并不排除在包括所述要素的过程、方法、物品或者终端设备中还存在另外的相同要素。
还需要说明的是,本领域内的技术人员应明白,本发明实施例的实施例可提供为方法、装置或计算机程序产品。而且,本发明实施例可采用在一个或多个其中包含有计算机可用程序代码的计算机可用存储介质(包括但不限于磁盘存储器、CD-ROM、光学存储器等)上实施的计算机程序产品的形式。
本发明实施例是参照根据本发明实施例的方法、终端设备(系统)、和计算机程序产品的流程图和/或方框图来描述的。应理解可由计算机程序指令实现流程图和/或方框图中的每一流程和/或方框、以及流程图和/或方框图中的流程和/或方框的结合。可提供这些计算机程序指令到通用计算机、嵌入式处理机或其他可编程数据处理终端设备的处理器以产生一个机器,使得通过计算机或其他可编程数据处理终端设备的处理器执行的指令产生用于实现在流程图一个流程或多个流程和/或方框图一个方框或多个方框中指定的功能的装置。
这些计算机程序指令也可存储在能引导计算机或其他可编程数据处理终端设备以特定方式工作的计算机可读存储器中,使得存储在该计算机可读存储器中的指令产生包括指令装置的制造品,该指令装置实现在流程图一个流程或多个流程和/或方框图一个方框或多个方框中指定的功能。这些计算机程序指令也可装载到计算机或其他可编程数据处理终端设备上,使得在计算机或其他可编程终端设备上执行一系列操作步骤以产生计算机实现的处理,从而在计算机或其他可编程终端设备上执行的指令提供用于实现在流程图一个流程或多个流程和/或方框图一个方框或多个方框中指定的功能的步骤。
以上所述是本发明的优选实施方式,应当指出,尽管已描述了本发明的优选实施例,但对于本技术领域的普通技术人员来说,一旦得知了本发明的基本创造性概念,在不脱离本发明所述原理的前提下,还可以做出若干改进和润饰,这些改进和润饰也应视为本发明的保护范围。所以,所附权利要求意欲解释为包括优选实施例以及落入本发明实施例范围的所有变更和修改。
Claims (6)
1.一种堆高机工作装置作业姿态自动调整控制方法,其特征在于,包括:
在堆高机带载行驶后,获取堆高机工作装置的姿态初值;并在获取所述姿态初值后实时采集所述堆高机工作装置的姿态测量值;
实时计算出所述堆高机工作装置的姿态测量值与姿态初值的差值,根据所述差值生成所述堆高机工作装置的控制信号;
根据所述控制信号实时调整所述堆高机工作装置的姿态,使得所述堆高机工作装置的姿态变化保持在预设范围内;
根据所述差值生成所述堆高机工作装置的控制信号:
S=C×U(ΔA);
U(ΔA)=P×ΔA+I×∫ΔAdt;
其中,S表示控制信号,C为预设常数,ΔA表示所述堆高机工作装置的姿态测量值与姿态初值的差值,P、I均为预设控制参数,t为获取堆高机工作装置姿态测量值与获取堆高机工作装置姿态初值的时间差,∫ΔAdt为差值在时间域上的积分;
将∫ΔAdt的绝对值与第一预设阈值进行比较;
当∫ΔAdt的绝对值不大于第一预设阈值时,按照第三控制方案为P赋值,且I=0,根据赋值结果计算出U(ΔA),并根据U(ΔA)计算出控制信号;
当∫ΔAdt的绝对值大于所述第一预设阈值时,所述方法还包括:实时采集所述堆高机的车速测量值;
计算出所述差值与所述堆高机相应时刻的车速测量值的比值,并将所述比值的绝对值与第二预设阈值进行比较;
当所述比值的绝对值大于所述第二预设阈值时,按照第一控制方案为P、I赋值,根据赋值结果计算出U(ΔA),并根据U(ΔA)计算出控制信号;
当所述比值的绝对值不大于所述第二预设阈值时,按照第二控制方案为P、I赋值,根据赋值结果计算出U(ΔA),并根据U(ΔA)计算出控制信号。
2.如权利要求1所述的堆高机工作装置作业姿态自动调整控制方法,其特征在于,所述获取堆高机工作装置的姿态初值,具体为:
当所述堆高机工作装置的直接或间接驱动油缸没有动作,所述堆高机有行驶或转向动作,且保持预设时间时,获取所述堆高机工作装置的姿态初值。
3.一种堆高机工作装置作业姿态自动调整控制系统,其特征在于,包括:
检测模块,用于在堆高机带载行驶后,获取堆高机工作装置的姿态初值;并在获取所述姿态初值后实时采集所述堆高机工作装置的姿态测量值;
控制模块,用于实时计算出所述堆高机工作装置的姿态测量值与姿态初值的差值,根据所述差值并生成所述堆高机工作装置的控制信号;
执行机构,用于根据所述控制信号实时调整所述堆高机工作装置的姿态,使得所述堆高机工作装置的姿态变化保持在预设范围内;
所述系统还包括车速传感器,所述车速传感器用于实时采集所述堆高机的车速测量值;所述控制模块具体用于:
根据所述差值生成所述堆高机工作装置的控制信号:
S=C×U(ΔA);
U(ΔA)=P×ΔA+I×∫ΔAdt;
其中,S表示控制信号,C为预设常数,ΔA表示所述堆高机工作装置的姿态测量值与姿态初值的差值,P、I均为预设控制参数,t为获取堆高机工作装置姿态测量值与获取堆高机工作装置姿态初值的时间差,∫ΔAdt为差值在时间域上的积分;
将∫ΔAdt的绝对值与第一预设阈值进行比较;
当∫ΔAdt的绝对值不大于第一预设阈值时,按照第三控制方案为P赋值,且I=0,根据赋值结果计算出U(ΔA),并根据U(ΔA)计算出控制信号;
当∫ΔAdt的绝对值大于所述第一预设阈值时,所述方法还包括:实时采集所述堆高机的车速测量值;
计算出所述差值与所述堆高机相应时刻的车速测量值的比值,并将所述比值的绝对值与第二预设阈值进行比较;
当所述比值的绝对值大于所述第二预设阈值时,按照第一控制方案为P、I赋值,根据赋值结果计算出U(ΔA),并根据U(ΔA)计算出控制信号;
当所述比值的绝对值不大于所述第二预设阈值时,按照第二控制方案为P、I赋值,根据赋值结果计算出U(ΔA),并根据U(ΔA)计算出控制信号。
4.如权利要求3所述的堆高机工作装置作业姿态自动调整控制系统,其特征在于,所述检测模块包括门架角度传感器或门架油缸长度传感器。
5.如权利要求3所述的堆高机工作装置作业姿态自动调整控制系统,其特征在于,所述控制模块包括集中式控制器、分布式控制器或远程控制器。
6.如权利要求3所述的堆高机工作装置作业姿态自动调整控制系统,其特征在于,所述执行机构包括门架油缸或动臂油缸。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201911223839.0A CN110775890B (zh) | 2019-12-03 | 2019-12-03 | 一种堆高机工作装置作业姿态自动调整控制方法及系统 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201911223839.0A CN110775890B (zh) | 2019-12-03 | 2019-12-03 | 一种堆高机工作装置作业姿态自动调整控制方法及系统 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110775890A true CN110775890A (zh) | 2020-02-11 |
CN110775890B CN110775890B (zh) | 2020-11-17 |
Family
ID=69393647
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201911223839.0A Active CN110775890B (zh) | 2019-12-03 | 2019-12-03 | 一种堆高机工作装置作业姿态自动调整控制方法及系统 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110775890B (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113832858A (zh) * | 2021-09-18 | 2021-12-24 | 中国船舶重工集团应急预警与救援装备股份有限公司 | 一种大跨度桥梁架设车的防倾翻预警及自适应调整系统 |
Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2001139294A (ja) * | 1999-11-16 | 2001-05-22 | Nippon Yusoki Co Ltd | フォークリフトの制御装置 |
US20050210713A1 (en) * | 2004-03-26 | 2005-09-29 | Mennen Kenneth C | Automatic hydraulic load leveling system for a work vehicle |
CN102459766A (zh) * | 2009-04-20 | 2012-05-16 | 罗伯特·博世有限公司 | 具有工作臂的位置控制装置的移动工作机械和用于控制移动工作机械的工作臂的位置的方法 |
CN102491239A (zh) * | 2011-12-08 | 2012-06-13 | 三一集团有限公司 | 一种叉车及其防倾翻控制方法、防倾翻控制系统 |
CN102575453A (zh) * | 2009-08-18 | 2012-07-11 | 罗伯特·博世有限公司 | 具有工作臂调节装置的移动式工作机及移动式工作机工作臂工作点调节的方法 |
CN106817058A (zh) * | 2015-11-27 | 2017-06-09 | 比亚迪股份有限公司 | 电动叉车的驱动控制方法、装置以及电动叉车 |
CN109573896A (zh) * | 2018-12-07 | 2019-04-05 | 朱浩 | 一种伸缩臂叉装车属具自动调平装置 |
CN110148325A (zh) * | 2018-07-24 | 2019-08-20 | 李力 | 一种集装箱空箱堆高机的操作技能仿真培训系统 |
-
2019
- 2019-12-03 CN CN201911223839.0A patent/CN110775890B/zh active Active
Patent Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2001139294A (ja) * | 1999-11-16 | 2001-05-22 | Nippon Yusoki Co Ltd | フォークリフトの制御装置 |
US20050210713A1 (en) * | 2004-03-26 | 2005-09-29 | Mennen Kenneth C | Automatic hydraulic load leveling system for a work vehicle |
CN102459766A (zh) * | 2009-04-20 | 2012-05-16 | 罗伯特·博世有限公司 | 具有工作臂的位置控制装置的移动工作机械和用于控制移动工作机械的工作臂的位置的方法 |
CN102575453A (zh) * | 2009-08-18 | 2012-07-11 | 罗伯特·博世有限公司 | 具有工作臂调节装置的移动式工作机及移动式工作机工作臂工作点调节的方法 |
CN102491239A (zh) * | 2011-12-08 | 2012-06-13 | 三一集团有限公司 | 一种叉车及其防倾翻控制方法、防倾翻控制系统 |
CN106817058A (zh) * | 2015-11-27 | 2017-06-09 | 比亚迪股份有限公司 | 电动叉车的驱动控制方法、装置以及电动叉车 |
CN110148325A (zh) * | 2018-07-24 | 2019-08-20 | 李力 | 一种集装箱空箱堆高机的操作技能仿真培训系统 |
CN109573896A (zh) * | 2018-12-07 | 2019-04-05 | 朱浩 | 一种伸缩臂叉装车属具自动调平装置 |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113832858A (zh) * | 2021-09-18 | 2021-12-24 | 中国船舶重工集团应急预警与救援装备股份有限公司 | 一种大跨度桥梁架设车的防倾翻预警及自适应调整系统 |
Also Published As
Publication number | Publication date |
---|---|
CN110775890B (zh) | 2020-11-17 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
KR101206312B1 (ko) | 크레인용 화물 제어 장치 | |
JP4856394B2 (ja) | コンテナクレーンの対象物位置計測装置と該対象物位置計測装置を用いた自動荷役装置 | |
US8504253B2 (en) | Device for controlling the movement of a load suspended from a crane | |
KR101950566B1 (ko) | 무인 운반차 | |
US10676327B2 (en) | Method for damping rotational oscillations of a load-handling element of a lifting device | |
CN103998367A (zh) | 起重机控制 | |
CN110775890B (zh) | 一种堆高机工作装置作业姿态自动调整控制方法及系统 | |
SE502609C2 (sv) | Förflyttning av gods med containerkranar | |
CN110905031B (zh) | 一种挖掘机工作装置作业姿态自动调整控制方法及系统 | |
US5878896A (en) | Method for controlling the swinging of a hanging load and device for the implementation of the method | |
CN113651242B (zh) | 集装箱起重机的控制方法、装置及存储介质 | |
CN111465572B (zh) | 卷扬机 | |
CN110905032A (zh) | 一种装载机工作装置作业姿态自动调整控制方法及系统 | |
JP2015509145A (ja) | 溶融炉内のチャージの管理方法と対応する積み込み装置 | |
CN110803625B (zh) | 一种正面吊工作装置作业姿态自动调整控制方法及系统 | |
JP4585303B2 (ja) | ヤードクレーン制御装置 | |
KR20190041015A (ko) | 크레인 장비, 특히 컨테이너 크레인을 위한 동작 방법 | |
CN110885039B (zh) | 一种叉车工作装置作业姿态自动调整控制方法及系统 | |
CN110885006B (zh) | 一种起重机工作装置作业姿态自动调整控制方法及系统 | |
JPH0489795A (ja) | 吊荷の振れ止め方法 | |
CN105417378A (zh) | 一种基于传感器的起重机防摇系统 | |
KR960041038A (ko) | 스프레더의 자동착지방법 및 그 장치 | |
CN108439214B (zh) | 岸桥的自动装卸方法 | |
CN112469658A (zh) | 起重机 | |
CN113753751B (zh) | 用于起重机防摇控制的方法、控制器、装置及起重机 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |