CN110905032A - 一种装载机工作装置作业姿态自动调整控制方法及系统 - Google Patents

一种装载机工作装置作业姿态自动调整控制方法及系统 Download PDF

Info

Publication number
CN110905032A
CN110905032A CN201911223866.8A CN201911223866A CN110905032A CN 110905032 A CN110905032 A CN 110905032A CN 201911223866 A CN201911223866 A CN 201911223866A CN 110905032 A CN110905032 A CN 110905032A
Authority
CN
China
Prior art keywords
loader
value
working device
attitude
control signal
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.)
Withdrawn
Application number
CN201911223866.8A
Other languages
English (en)
Inventor
韩慧芳
曹显利
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Deep Knowledge Intelligent Technology Jinhua Co Ltd
Original Assignee
Deep Knowledge Intelligent Technology Jinhua Co Ltd
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Deep Knowledge Intelligent Technology Jinhua Co Ltd filed Critical Deep Knowledge Intelligent Technology Jinhua Co Ltd
Priority to CN201911223866.8A priority Critical patent/CN110905032A/zh
Publication of CN110905032A publication Critical patent/CN110905032A/zh
Withdrawn legal-status Critical Current

Links

Images

Classifications

    • EFIXED CONSTRUCTIONS
    • E02HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02FDREDGING; SOIL-SHIFTING
    • E02F9/00Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
    • E02F9/20Drives; Control devices
    • E02F9/2025Particular purposes of control systems not otherwise provided for
    • E02F9/2029Controlling the position of implements in function of its load, e.g. modifying the attitude of implements in accordance to vehicle speed

Abstract

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

Description

一种装载机工作装置作业姿态自动调整控制方法及系统
技术领域
本发明涉及装载机控制技术领域,特别是指一种装载机工作装置作业姿态自动调整控制方法及系统。
背景技术
装载机是一种铲土运输机械,用于松散物料的铲掘、收集、堆高、运输、装车等场合,其工作装置包括臂架、铲斗、驱动油缸和附件等。
装载机在运输和装车等工况下,由于行驶路面的颠簸不平,导致铲斗随整车一起颠簸,进而导致铲斗中的物料洒落,影响了装载机的工作效率,也影响装载机工作场地的清洁。
而目前现有技术中并没有一套切实可行的控制方案可以对装载机的工作装置的姿态进行主动实时控制,以抵消路面颠簸对装载机铲斗的影响,尤其是抵消路面颠簸对装载机铲斗角度的影响,从而解决装载机工作过程中整机、尤其是铲斗随行驶路面一起颠簸的问题。
发明内容
本发明要解决的技术问题是提供一种装载机工作装置作业姿态自动调整控制方法及系统,解决装载机工作过程中整机、尤其是铲斗随行驶路面一起颠簸的问题,实现对装载机的工作装置的姿态进行主动实时控制,以抵消路面颠簸对装载机铲斗的影响,尤其是抵消路面颠簸对装载机铲斗角度的影响。
为解决上述技术问题,本发明提供如下技术方案:
一种装载机工作装置作业姿态自动调整控制方法,包括:
在装载机完成物料收集后,获取装载机工作装置的姿态初值;并在获取所述姿态初值后实时采集所述装载机工作装置的姿态测量值;
实时计算出所述装载机工作装置的姿态测量值与姿态初值的差值,并根据所述差值生成所述装载机工作装置的控制信号;
根据所述控制信号实时调整所述装载机工作装置的姿态,使得所述装载机工作装置的姿态变化保持在预设范围内。
其中,所述获取装载机工作装置的姿态初值,具体为:
当所述装载机工作装置的直接或间接驱动油缸没有动作,所述装载机有行驶或转向动作,且保持预设时间时,获取所述装载机工作装置的姿态初值。
其中,所述根据所述差值生成所述装载机工作装置的控制信号,包括:
将所述差值的绝对值与第一预设阈值进行比较;
当所述差值的绝对值不大于第一预设阈值时,生成大小为零的控制信号;
当所述差值的绝对值大于第一预设阈值时,根据下式生成控制信号:
S=C×U(△A);
U(△A)=P×△A+I×∫△Adt+D×d△A/dt;
其中,S表示控制信号,C为预设常数,△A表示所述装载机工作装置的姿态测量值与姿态初值的差值,P、I、D均为预设控制参数,d△A/dt为差值变化率,t为获取装载机工作装置姿态测量值与获取装载机工作装置姿态初值的时间差。
其中,所述△A是一个离散量,记为△A(k);
所述U(△A)的算式经过离散化的计算式为:
Figure BDA0002300940810000021
其中,k为采样序号;
为提高运算速度,进一步将上式进行优化如下:
令△(k)=△A(k)-△A(k-1),△U=U(△A(k))-U(△A(k-1)),则△U表示为:
△U=P×△(k)+I×△A(k)+D×[△(k)-△(k-1)]
所以,U(△A(k))按照以下方法进行输出:
U(△A(k))=U(△A(k-1))+△U。
其中,所述方法还包括:实时采集所述装载机的车速测量值;
当所述差值大于所述第一预设阈值时,所述方法还包括:
计算出所述差值与所述装载机相应时刻的车速测量值的比值,并将所述比值的绝对值与第二预设阈值进行比较;
当所述比值的绝对值大于所述第二预设阈值时,按照第一控制方案为P、I、D赋值,根据赋值结果计算出U(△A),并根据U(△A)计算出控制信号;
当所述比值的绝对值不大于所述第二预设阈值时,按照第二控制方案为P赋值,且I=0,D=0,根据赋值结果计算出U(△A),并根据U(△A)计算出控制信号。
相应地,为解决上述技术问题,本发明还提供如下技术方案:
一种装载机工作装置作业姿态自动调整控制系统,包括:
检测模块,用于在装载机完成物料收集后,获取装载机工作装置的姿态初值;并在获取所述姿态初值后实时采集所述装载机工作装置的姿态测量值;
控制模块,用于实时计算出所述装载机工作装置的姿态测量值与姿态初值的差值,并根据所述差值生成所述装载机工作装置的控制信号;
执行机构,用于根据所述控制信号实时调整所述装载机工作装置的姿态,使得所述装载机工作装置的姿态变化保持在预设范围内。
其中,所述检测模块包括铲斗角度传感器或铲斗油缸长度传感器。
其中,所述控制模块包括集中式控制器、分布式控制器或远程控制器。
其中,所述执行机构包括铲斗油缸或动臂油缸。
其中,所述控制模块具体用于:
将所述差值的绝对值与第一预设阈值进行比较;
当所述差值的绝对值不大于第一预设阈值时,生成大小为零的控制信号;
当所述差值的绝对值大于第一预设阈值时,根据下式生成控制信号:
S=C×U(△A);
U(ΔA)=P×ΔA+I×∫△Adt+D×d△A/dt;
其中,S表示控制信号,C为预设常数,ΔA表示所述装载机工作装置的姿态测量值与姿态初值的差值,P、I、D均为预设控制参数,dΔA/dt为差值变化率,t为获取装载机工作装置姿态测量值与获取装载机工作装置姿态初值的时间差。
其中,所述系统还包括车速传感器,所述车速传感器用于实时采集所述装载机的车速测量值;
当所述差值大于所述第一预设阈值时,所述控制模块还用于:
计算出所述差值与所述装载机相应时刻的车速测量值的比值,并将所述比值的绝对值与第二预设阈值进行比较;
当所述比值的绝对值大于所述第二预设阈值时,按照第一控制方案为P、I、D赋值,根据赋值结果计算出U(△A),并根据U(ΔA)计算出控制信号;
当所述比值的绝对值不大于所述第二预设阈值时,按照第二控制方案为P赋值,且I=0,D=0,根据赋值结果计算出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;当△A在一个小范围内波动时,对铲斗的影响很小,此时可以不必对此进行控制,因此,需要预设一个第一预设阈值A1;具体地,本实施例中,A1=3°。
S22,判断△A的绝对值是否大于第一预设阈值A1;
S23,当△A的绝对值不大于A1时,令U(△A)=0;
S24,当△A的绝对值大于A1时,说明此时铲斗的角度偏差已经很明显,需要主动进行控制,而且考虑到在不同行驶速度下,相同的△A代表的含义并不相同:同等△A下,车速V越低,说明路面颠簸情况越大,对铲斗倾角的影响也越大,因此,需要考虑车速V的影响,进一步执行以下流程:
S25,计算△A与装载机相应时刻的车速测量值V的比值B;并判断B的绝对值是否大于第二预设阈值B1;具体地,本实施例中,B1=1°km/h。
S26,当B的绝对值大于B1时,采用第一套控制参数(P1,I1,D1),具体地,本实施例中,P1=2,I1=1,D1=5;
此时,U(ΔA)=P1×△A+I1×∫△Adt+D1×dΔA/dt;
S27,当B的绝对值不大于B1时,按照第二套控制参数(P2,I2=0,D2=0),具体地,本实施例中,P2=3;
此时,U(ΔA)=P2×△A;
S28,根据U(ΔA),计算出工作装置驱动油缸的电磁阀控制信号S:
S=C×U(ΔA);
其中,C为预设常数,具体地,在本实施例中,取C=1。
其中,需要说明的是,对于ΔA,在实际运算中,由于测量值A是经过控制器采样得到的数据,因而是一个离散量。由A计算得出的ΔA也是一个离散量,记为△A(k)。所以,上面U(△A)的算式在实际应用中经过离散化的计算式为:
Figure BDA0002300940810000061
其中,k为采样序号。
由于上式中的
Figure BDA0002300940810000062
需要大量计算,导致运算时间较长。为了提高运算速度,进一步将上式进行优化。
令△(k)=ΔA(k)-ΔA(k-1),ΔU=U(ΔA(k))-U(ΔA(k-1)),则ΔU可表示为:
ΔU=P×Δ(k)+I×ΔA(k)+D×[Δ(k)-Δ(k-1)]
所以,U(ΔA(k))可以按照以下方法进行输出:
U(ΔA(k))=U(ΔA(k-1))+ΔU。
S3,根据控制信号实时调整装载机工作装置的姿态,使得装载机工作装置的姿态变化保持在预设范围内。
需要说明的是,上述步骤是通过控制信号对铲斗的执行机构(包括铲斗油缸或动臂油缸等)进行输出控制,通过对铲斗倾角的主动控制,抵消路面颠簸对铲斗倾角的影响,以此实现铲斗实际倾角在行驶过程中的稳定。
本实施例的自动调整控制方法可以根据装载机行驶路面的变化,实时调整装载机工作装置的姿态,使得装载机在行驶过程中保持铲斗角度对路面颠簸的跟随控制。解决了装载机工作过程中整机、尤其是铲斗随行驶路面一起颠簸的问题,实现了对装载机的工作装置的姿态进行主动实时控制,抵消了路面颠簸对装载机铲斗的影响,尤其是抵消了路面颠簸对装载机铲斗角度的影响。
第二实施例
本实施例提供一种装载机工作装置作业姿态自动调整控制系统,如图2所示,所述装载机工作装置作业姿态自动调整控制系统包括:
检测模块,用于在装载机完成物料收集后,获取装载机工作装置的姿态初值A0;并在获取A0后实时采集装载机工作装置的姿态测量值A;
控制模块,用于实时计算出装载机工作装置的姿态测量值A与姿态初值A0的差值ΔA,并根据ΔA生成装载机工作装置的控制信号S;
执行机构,用于根据控制信号S实时调整装载机工作装置的姿态,使得装载机工作装置的姿态变化保持在预设范围内。
此外,如图3所示,本实施例的装载机工作装置作业姿态自动调整控制系统还包括车速传感器,所述车速传感器用于实时采集装载机的车速测量值。
具体地,在本实施例中,上述检测模块为工作装置位置传感器,可以包括铲斗角度传感器或铲斗油缸长度传感器。通过测量铲斗的倾角或所有铲斗驱动油缸的位置,直接或间接计算得到铲斗的姿态;
装载机工作装置的姿态初值A0的保存条件为:装载机工作装置的直接或间接驱动油缸没有动作(控制器没有信号输出),装载机有行驶或转向动作,且保持预设时间;具体地,在本实施例中,该预设时间为3秒。
考虑到实际工作中,装载机颠簸的主要成分来自于装载机整机绕垂直于行驶方向上的水平轴线的转动,该转动导致铲斗倾角的变化,进而导致物料洒落。因此,本实施例采用铲斗角度传感器获得铲斗的倾角信息。
控制模块可以包括集中式控制器、分布式控制器或远程控制器,本实施例采用集中式控制器,其具体用于:
计算出装载机工作装置的姿态测量值A与姿态初值A0的差值ΔA;当ΔA在一个小范围内波动时,对铲斗的影响很小,此时可以不必对此进行控制,因此,需要预设一个第一预设阈值A1;具体地,本实施例中,A1=3°。
判断ΔA的绝对值是否大于第一预设阈值A1;
当ΔA的绝对值不大于A1时,令U(ΔA)=0;
当ΔA的绝对值大于A1时,说明此时铲斗的角度偏差已经很明显,需要主动进行控制,而且考虑到在不同行驶速度下,相同的ΔA代表的含义并不相同:同等ΔA下,车速V越低,说明路面颠簸情况越大,对铲斗倾角的影响也越大,因此,需要考虑车速V的影响,进一步执行以下流程:
计算ΔA与装载机相应时刻的车速测量值V的比值B;并判断B的绝对值是否大于第二预设阈值B1;具体地,,本实施例中,B1=1°km/h。
当B的绝对值大B1时,采用第一套控制参数((P1,I1,D1),具体地,本实施例中,P1=2,I1=1,D1=5;
此时,U(ΔA)=P1×ΔA+I1×∫ΔAdt+D1×dΔA/dt;
当B的绝对值不大于B1时,按照第二套控制参数(P2,I2=0,D2=0),具体地,本实施例中,P2=3;
此时,U(ΔA)=P2×ΔA;
根据U(△A),计算出工作装置驱动油缸的电磁阀控制信号S:
S=C×U(△A);
其中,C为预设常数,具体地,在本实施例中,取C=1。
上述执行机构为工作装置驱动油缸,用于直接或间接驱动装载机铲斗动作,可以包括铲斗油缸、动臂油缸等。
本实施例的自动调整控制系统可以根据装载机行驶路面的变化,实时调整装载机工作装置的姿态,使得装载机在行驶过程中保持铲斗角度对路面颠簸的跟随控制。解决了装载机工作过程中整机、尤其是铲斗随行驶路面一起颠簸的问题,实现了对装载机的工作装置的姿态进行主动实时控制,抵消了路面颠簸对装载机铲斗的影响,尤其是抵消了路面颠簸对装载机铲斗角度的影响。
此外,需要说明的是,在本文中,诸如第一和第二等之类的关系术语仅仅用来将一个实体或者操作与另一个实体或操作区分开来,而不一定要求或者暗示这些实体或操作之间存在任何这种实际的关系或者顺序。
而且,术语“包括”、“包含”或者其任何其他变体意在涵盖非排他性的包含,从而使得包括一系列要素的过程、方法、物品或者终端设备不仅包括那些要素,而且还包括没有明确列出的其他要素,或者是还包括为这种过程、方法、物品或者终端设备所固有的要素。在没有更多限制的情况下,由语句“包括一个……”限定的要素,并不排除在包括所述要素的过程、方法、物品或者终端设备中还存在另外的相同要素。
还需要说明的是,本领域内的技术人员应明白,本发明实施例的实施例可提供为方法、装置或计算机程序产品。而且,本发明实施例可采用在一个或多个其中包含有计算机可用程序代码的计算机可用存储介质(包括但不限于磁盘存储器、CD-ROM、光学存储器等)上实施的计算机程序产品的形式。
本发明实施例是参照根据本发明实施例的方法、终端设备(系统)、和计算机程序产品的流程图和/或方框图来描述的。应理解可由计算机程序指令实现流程图和/或方框图中的每一流程和/或方框、以及流程图和/或方框图中的流程和/或方框的结合。可提供这些计算机程序指令到通用计算机、嵌入式处理机或其他可编程数据处理终端设备的处理器以产生一个机器,使得通过计算机或其他可编程数据处理终端设备的处理器执行的指令产生用于实现在流程图一个流程或多个流程和/或方框图一个方框或多个方框中指定的功能的装置。
这些计算机程序指令也可存储在能引导计算机或其他可编程数据处理终端设备以特定方式工作的计算机可读存储器中,使得存储在该计算机可读存储器中的指令产生包括指令装置的制造品,该指令装置实现在流程图一个流程或多个流程和/或方框图一个方框或多个方框中指定的功能。这些计算机程序指令也可装载到计算机或其他可编程数据处理终端设备上,使得在计算机或其他可编程终端设备上执行一系列操作步骤以产生计算机实现的处理,从而在计算机或其他可编程终端设备上执行的指令提供用于实现在流程图一个流程或多个流程和/或方框图一个方框或多个方框中指定的功能的步骤。
以上所述是本发明的优选实施方式,应当指出,尽管已描述了本发明的优选实施例,但对于本技术领域的普通技术人员来说,一旦得知了本发明的基本创造性概念,在不脱离本发明所述原理的前提下,还可以做出若干改进和润饰,这些改进和润饰也应视为本发明的保护范围。所以,所附权利要求意欲解释为包括优选实施例以及落入本发明实施例范围的所有变更和修改。

Claims (10)

1.一种装载机工作装置作业姿态自动调整控制方法,其特征在于,包括:
在装载机完成物料收集后,获取装载机工作装置的姿态初值;并在获取所述姿态初值后实时采集所述装载机工作装置的姿态测量值;
实时计算出所述装载机工作装置的姿态测量值与姿态初值的差值,并根据所述差值生成所述装载机工作装置的控制信号;
根据所述控制信号实时调整所述装载机工作装置的姿态,使得所述装载机工作装置的姿态变化保持在预设范围内。
2.如权利要求1所述的装载机工作装置作业姿态自动调整控制方法,其特征在于,所述获取装载机工作装置的姿态初值,具体为:
当所述装载机工作装置的直接或间接驱动油缸没有动作,所述装载机有行驶或转向动作,且保持预设时间时,获取所述装载机工作装置的姿态初值。
3.如权利要求1所述的装载机工作装置作业姿态自动调整控制方法,其特征在于,根据所述差值生成所述装载机工作装置的控制信号,包括:
将所述差值的绝对值与第一预设阈值进行比较;
当所述差值的绝对值不大于第一预设阈值时,生成大小为零的控制信号;
当所述差值的绝对值大于第一预设阈值时,根据下式生成控制信号:
S=C×U(ΔA);
U(ΔA)=P×ΔA+I×∫ΔAdt+D×dΔA/dt;
其中,S表示控制信号,C为预设常数,ΔA表示所述装载机工作装置的姿态测量值与姿态初值的差值,P、I、D均为预设控制参数,t为获取装载机工作装置姿态测量值与获取装载机工作装置姿态初值的时间差。
4.如权利要求3所述的装载机工作装置作业姿态自动调整控制方法,其特征在于,所述ΔA是一个离散量,记为ΔA(k);
所述U(ΔA)的算式经过离散化的计算式为:
Figure FDA0002300940800000011
其中,k为采样序号;
为提高运算速度,将上式进行优化如下:
令Δ(k)=ΔA(k)-ΔA(k-1),ΔU=U(ΔA(k))-U(ΔA(k-1)),则ΔU表示为:
ΔU=P×Δ(k)+I×ΔA(k)+D×[Δ(k)-Δ(k-1)];
所以,U(ΔA(k))按照以下方法进行输出:
U(ΔA(k))=U(ΔA(k-1))+ΔU。
5.如权利要求3所述的装载机工作装置作业姿态自动调整控制方法,其特征在于,所述方法还包括:实时采集所述装载机的车速测量值;
当所述差值大于所述第一预设阈值时,所述方法还包括:
计算出所述差值与所述装载机相应时刻的车速测量值的比值,并将所述比值的绝对值与第二预设阈值进行比较;
当所述比值的绝对值大于所述第二预设阈值时,按照第一控制方案为P、I、D赋值,根据赋值结果计算出U(ΔA),并根据U(ΔA)计算出控制信号;
当所述比值的绝对值不大于所述第二预设阈值时,按照第二控制方案为P赋值,且I=0,D=0,根据赋值结果计算出U(ΔA),并根据U(ΔA)计算出控制信号。
6.一种装载机工作装置作业姿态自动调整控制系统,其特征在于,包括:
检测模块,用于在装载机完成物料收集后,获取装载机工作装置的姿态初值;并在获取所述姿态初值后实时采集所述装载机工作装置的姿态测量值;
控制模块,用于实时计算出所述装载机工作装置的姿态测量值与姿态初值的差值,并根据所述差值生成所述装载机工作装置的控制信号;
执行机构,用于根据所述控制信号实时调整所述装载机工作装置的姿态,使得所述装载机工作装置的姿态变化保持在预设范围内。
7.如权利要求6所述的装载机工作装置作业姿态自动调整控制系统,其特征在于,所述检测模块包括铲斗角度传感器或铲斗油缸长度传感器;所述执行机构包括铲斗油缸或动臂油缸。
8.如权利要求6所述的装载机工作装置作业姿态自动调整控制系统,其特征在于,所述控制模块包括集中式控制器、分布式控制器或远程控制器。
9.如权利要求6所述的装载机工作装置作业姿态自动调整控制系统,其特征在于,所述控制模块具体用于:
将所述差值的绝对值与第一预设阈值进行比较;
当所述差值的绝对值不大于第一预设阈值时,生成大小为零的控制信号;
当所述差值的绝对值大于所述第一预设阈值时,根据下式生成控制信号:
S=C×U(ΔA);
U(ΔA)=P×ΔA+I×∫ΔAdt+D×dΔA/dt;
其中,S表示控制信号,C为预设常数,ΔA表示所述装载机工作装置的姿态测量值与姿态初值的差值,P、I、D均为预设控制参数,dΔA/dt为差值变化率,t为获取装载机工作装置姿态测量值与获取装载机工作装置姿态初值的时间差。
10.如权利要求9所述的装载机工作装置作业姿态自动调整控制方法,其特征在于,所述系统还包括车速传感器,所述车速传感器用于实时采集所述装载机的车速测量值;
当所述差值大于所述第一预设阈值时,所述控制模块还用于:
计算出所述差值与所述装载机相应时刻的车速测量值的比值,并将所述比值的绝对值与第二预设阈值进行比较;
当所述比值的绝对值大于所述第二预设阈值时,按照第一控制方案为P、I、D赋值,根据赋值结果计算出U(ΔA),并根据U(ΔA)计算出控制信号;
当所述比值的绝对值不大于所述第二预设阈值时,按照第二控制方案为P赋值,且I=0,D=0,根据赋值结果计算出U(ΔA),并根据U(ΔA)计算出控制信号。
CN201911223866.8A 2019-12-03 2019-12-03 一种装载机工作装置作业姿态自动调整控制方法及系统 Withdrawn CN110905032A (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201911223866.8A CN110905032A (zh) 2019-12-03 2019-12-03 一种装载机工作装置作业姿态自动调整控制方法及系统

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201911223866.8A CN110905032A (zh) 2019-12-03 2019-12-03 一种装载机工作装置作业姿态自动调整控制方法及系统

Publications (1)

Publication Number Publication Date
CN110905032A true CN110905032A (zh) 2020-03-24

Family

ID=69821820

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201911223866.8A Withdrawn CN110905032A (zh) 2019-12-03 2019-12-03 一种装载机工作装置作业姿态自动调整控制方法及系统

Country Status (1)

Country Link
CN (1) CN110905032A (zh)

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN112160361A (zh) * 2020-09-21 2021-01-01 徐州徐工铁路装备有限公司 一种铲运机工作装置姿态自动调整控制方法
CN113279449A (zh) * 2020-12-29 2021-08-20 徐州徐工基础工程机械有限公司 一种铲运机工作装置特定姿态一键循迹控制方法

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20150098785A1 (en) * 2013-10-04 2015-04-09 Kubota Corporation Front loader
CN108699805A (zh) * 2016-03-23 2018-10-23 株式会社小松制作所 机动平路机的控制方法以及机动平路机
CN108894272A (zh) * 2018-07-31 2018-11-27 青岛雷沃工程机械有限公司 一种挖掘机自动引导施工系统及施工方法
CN108978768A (zh) * 2018-06-29 2018-12-11 广西柳工机械股份有限公司 铲斗插入物料的自动识别方法及装载机自动铲装控制方法
CN109296019A (zh) * 2018-11-08 2019-02-01 北京拓疆者智能科技有限公司 挖掘机臂运动控制方法、系统及装置
CN110409530A (zh) * 2019-08-13 2019-11-05 中国水利水电第五工程局有限公司 一种推土机自动控制系统及控制方法

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20150098785A1 (en) * 2013-10-04 2015-04-09 Kubota Corporation Front loader
CN108699805A (zh) * 2016-03-23 2018-10-23 株式会社小松制作所 机动平路机的控制方法以及机动平路机
CN108978768A (zh) * 2018-06-29 2018-12-11 广西柳工机械股份有限公司 铲斗插入物料的自动识别方法及装载机自动铲装控制方法
CN108894272A (zh) * 2018-07-31 2018-11-27 青岛雷沃工程机械有限公司 一种挖掘机自动引导施工系统及施工方法
CN109296019A (zh) * 2018-11-08 2019-02-01 北京拓疆者智能科技有限公司 挖掘机臂运动控制方法、系统及装置
CN110409530A (zh) * 2019-08-13 2019-11-05 中国水利水电第五工程局有限公司 一种推土机自动控制系统及控制方法

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN112160361A (zh) * 2020-09-21 2021-01-01 徐州徐工铁路装备有限公司 一种铲运机工作装置姿态自动调整控制方法
CN113279449A (zh) * 2020-12-29 2021-08-20 徐州徐工基础工程机械有限公司 一种铲运机工作装置特定姿态一键循迹控制方法

Similar Documents

Publication Publication Date Title
CN110905031B (zh) 一种挖掘机工作装置作业姿态自动调整控制方法及系统
US10401856B2 (en) Vehicle travel control apparatus
CN109101032B (zh) 用于利用传感器融合来控制机器姿态的系统和方法
CN106436791B (zh) 具有改进的器具位置控制和自找平功能的作业车辆
US7121355B2 (en) Bulldozer autograding system
US9822507B2 (en) Work vehicle with enhanced implement position control and bi-directional self-leveling functionality
CN109099033B (zh) 利用传感器融合反馈在机器中控制流体压力的方法和系统
CN110905032A (zh) 一种装载机工作装置作业姿态自动调整控制方法及系统
CN104206063A (zh) 一种作业机具自动调平系统及其控制方法
WO2008118027A2 (en) Method for planning the path of a contour-shaping machine
US20140107896A1 (en) System and Method for Estimating Machine Pitch Angle
CN110905020B (zh) 一种推土机工作装置作业姿态自动调整控制方法及系统
JPH07180107A (ja) 建設機械の3次元位置自動制御方法
CN112896147B (zh) 用于矿用车辆的双向定位泊车控制方法及装置
CN110905021B (zh) 一种平地机工作装置作业姿态自动调整控制方法及系统
EP3825474A1 (en) Blade control device for work machine
CN110741749A (zh) 一种旋耕机工作装置作业姿态自动调整控制方法及系统
CN110731164B (zh) 一种收割机工作装置作业姿态自动调整控制方法及系统
CN110775890B (zh) 一种堆高机工作装置作业姿态自动调整控制方法及系统
US20210324604A1 (en) Blade control device for work machinery
CN117681870A (zh) 转向控制器和转向控制方法
CN110803625B (zh) 一种正面吊工作装置作业姿态自动调整控制方法及系统
CN110885039B (zh) 一种叉车工作装置作业姿态自动调整控制方法及系统
CN110885006B (zh) 一种起重机工作装置作业姿态自动调整控制方法及系统
US20210324605A1 (en) Blade control device for work machinery

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
WW01 Invention patent application withdrawn after publication

Application publication date: 20200324

WW01 Invention patent application withdrawn after publication