CN110409546B - 一种挖掘机的电控系统及正流量系统挖掘机 - Google Patents

一种挖掘机的电控系统及正流量系统挖掘机 Download PDF

Info

Publication number
CN110409546B
CN110409546B CN201910674734.0A CN201910674734A CN110409546B CN 110409546 B CN110409546 B CN 110409546B CN 201910674734 A CN201910674734 A CN 201910674734A CN 110409546 B CN110409546 B CN 110409546B
Authority
CN
China
Prior art keywords
bucket
control
excavator
boom
attitude
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.)
Active
Application number
CN201910674734.0A
Other languages
English (en)
Other versions
CN110409546A (zh
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.)
Xian Flight Automatic Control Research Institute of AVIC
Original Assignee
Xian Flight Automatic Control Research Institute of AVIC
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 Xian Flight Automatic Control Research Institute of AVIC filed Critical Xian Flight Automatic Control Research Institute of AVIC
Priority to CN201910674734.0A priority Critical patent/CN110409546B/zh
Publication of CN110409546A publication Critical patent/CN110409546A/zh
Application granted granted Critical
Publication of CN110409546B publication Critical patent/CN110409546B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • E—FIXED CONSTRUCTIONS
    • E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02F—DREDGING; SOIL-SHIFTING
    • E02F9/00—Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
    • E02F9/20—Drives; Control devices

Landscapes

  • Engineering & Computer Science (AREA)
  • Mining & Mineral Resources (AREA)
  • Civil Engineering (AREA)
  • General Engineering & Computer Science (AREA)
  • Structural Engineering (AREA)
  • Operation Control Of Excavators (AREA)

Abstract

本发明提供一种挖掘机的电控系统，包括控制器总成，倾角传感器装置，控制阀装置：所述控制器总成还包括铲斗轨迹自动控制装置，铲斗轨迹自动控制装置与所述挖掘机手柄连接，所述铲斗轨迹自动控制装置来实现挖掘机铲斗轨迹的直线轨迹自动控制。本发明的挖掘机电控系统，根据动臂、斗杆的姿态角速率满足的定量关系，将直线挖掘铲斗轨迹控制转化为工作装置姿态角速率的匹配控制，在省去轨迹规划和轨迹到姿态角度的逆运算等复杂计算的同时也提高了控制的频带和响应速度，且便于加工、成本低，有利于实现批量化生产。

Description

一种挖掘机的电控系统及正流量系统挖掘机
技术领域
本发明涉及挖掘机控制领域，具体涉及一种挖掘机的电控系统及正流量系统挖掘机。
背景技术
随着挖掘机电控技术的发展，对挖掘机控制自动化水平提出了越来越高的要求。例如在挖掘机修边坡或地面整平时，需要仅控制一个手柄就实现铲斗轨迹的直线控制，这就要求斗杆和大臂能够自动实现位置的精确匹配控制。
目前针对铲斗自动轨迹控制的研究都是将规划的铲斗轨迹转化为各工作装置的目标角度序列，进而通过工作装置的角度跟踪控制实现铲斗轨迹的跟踪控制。
现有技术中，通过模糊控制动态调整控制参数实现作业轨迹的自动控制，或使用带有低通滤波器的滑膜算法实现了工作装置轨迹跟踪控制。中南大学基于拉格朗日和伯努利方程，建立了工作装置的动力学模型，在SWE85挖掘机平台上分别使用PID控制、滑膜变结构控制和自适应控制技术实现了铲斗轨迹的跟踪控制。解放军理工大学基于笛卡尔空间建立了工装运动学模型，通过离线轨迹规划和在线轨迹跟踪设计了铲斗轨迹控制策略，并针对模型的非线性采用了分段PID补偿控制，基于实验室小型挖掘机平台完成了实验，精度达到了 5cm。波兰华沙机械化建设与岩石开采研究所将小型挖掘机K-111改造成负载独立控制系统，实现了铲斗轨迹自动控制，但由于其没有实现位置闭环，铲斗运动速度只能达到2米每分钟，其误差范围在4％到15％。
以上现有技术均基于小型挖掘机平台，其液压系统均为具有出色可控性的负载独立控制系统，对大型正流量系统挖掘机并不适用。正流量系统中工作臂的速度不仅依赖阀口开度还取决于负载压力，复合动作时工作臂之间因为流量耦合存在着速度干扰，协调运动非常困难。
发明内容
因此，为了克服上述现有技术的缺点，本发明提供一种挖掘机铲斗轨迹自动控制装置、方法和计算机可读存储介质。
为实现上述目的，本发明提供一种挖掘机的电控系统，包括控制器总成，倾角传感器装置，控制阀装置；
其中，所述控制器总成与所述倾角传感器装置连接，接收来自所述倾角传感器的信号；所述控制器总成与挖掘机手柄相连接，接收来自挖掘机手柄位移量信号，以确定挖掘机斗杆的控制阀阀芯的位移量，从而控制挖掘机斗杆移动；所述控制器总成与所述控制阀连接，用于向所述控制阀发送控制信号，以控制所述控制阀控制所述挖掘机的铲斗油缸、斗杆油缸和动臂油缸移动；还包括位移传感器，所述位移传感器与所述控制阀装置和所述控制器总成连接，所述位移传感器监控所述控制阀系统的主阀芯的位移，并将位移信号反馈给所述控制器总成；
所述控制器总成还包括铲斗轨迹自动控制装置，铲斗轨迹自动控制装置与所述挖掘机手柄连接，所述铲斗轨迹自动控制装置能够根据挖掘机的动臂和斗杆的姿态角速率的定量关系，以及所述挖掘机手柄的位移量信号来实现挖掘机铲斗轨迹的直线轨迹自动控制。
进一步地，所述铲斗轨迹自动控制装置包括：
定量关系确定单元，用于根据挖掘机铲斗位置和挖掘机铲斗轨迹来确定挖掘机的动臂和斗杆的姿态角速率之间的定量关系；
斗杆控制单元，根据挖掘机操纵手柄的位移量，确定所述斗杆的控制阀阀芯的位移量，控制所述斗杆移动；
动臂姿态角速率确定单元，用于确定所述斗杆的姿态角速率，根据定量关系确定单元中确定的定量关系，确定所述动臂的姿态角速率；
动臂前馈控制单元，根据动臂姿态角速率确定单元确定的所述动臂的姿态角速率，确定所述动臂的控制阀阀芯位移的前馈控制量；
动臂反馈控制单元，用于接收动臂姿态传感器反馈的动臂姿态角速率，根据动臂姿态角速率确定单元中确定的动臂姿态角速率和动臂姿态传感器反馈的动臂姿态角速率之间的差值，确定所述动臂的控制阀阀芯位移的反馈控制量；
动臂控制单元，根据所述动臂的控制阀阀芯位移的前馈控制量和反馈控制量，确定所述动臂控制阀的阀芯位移控制量，控制所述动臂移动。
进一步地，所述倾角传感器装置进一步包括：
铲斗姿态传感器，用于检测以铲斗绕斗杆的轴中心为坐标原点的坐标系中的铲斗姿态；
斗杆姿态传感器，用于检测以斗杆绕动臂的转轴中心为坐标原点的坐标系中的斗杆姿态；
动臂姿态传感器，用于检测以动臂绕车体的转轴中心为坐标原点的坐标系中的动臂姿态；
所述铲斗姿态传感器、斗杆姿态传感器、动臂姿态传感器分别与所述铲斗轨迹自动控制装置连接，用于将各自监测的独立坐标信号反馈给所述铲斗轨迹自动控制装置。
进一步地，所述铲斗轨迹自动控制装置包括坐标转换单元，所述坐标转换单元将所述铲斗姿态传感器、斗杆姿态传感器、动臂姿态传感器各自的坐标系实时信号转换为以挖掘机车体回转中心为坐标原点的坐标系O0x0y0z0中的坐标信号。
进一步地，所述铲斗轨迹自动控制装置进一步包括姿态角速率换算单元，所述姿态角速率换算单元根据坐标转换单元转换的铲斗的齿间中心的初始位置和实时位置，来确定挖掘机的动臂和斗杆的姿态角速率之间的定量关系。
进一步地，通过使铲斗的齿间中心在O0x0y0z0坐标系中的实时位置的代价函数h(xp0，zp0)＝|zp0-tanμ·xp0+tanμ·ap0-cp0|＝0来确定挖掘机的动臂和斗杆的姿态角速率之间的定量关系，其中，μ为挖掘机铲斗的直线挖掘轨迹与O0x0y0z0中 x0轴的夹角，所述x0轴与所述挖掘机的上车体的水平指向相同；(ap0，bp0，cp0)为铲斗齿间中心在所述O0x0y0z0坐标系中初始位置。
进一步地，所述控制阀装置包括1级DDV阀和2级多路主控阀。
进一步地，所述铲斗轨迹自动控制装置包括前馈控制单元，所述前馈控制单元与所述动臂的控制阀连接，利用神经网络算法对挖掘机动臂的控制阀阀芯位移进行前馈控制。
进一步地，所述铲斗轨迹自动控制装置包括反馈控制单元，所述反馈控制单元与所述动臂的控制阀连接，利用比例积分算法对挖掘机动臂的控制阀阀芯位移的进行反馈控制。
本发明还一种正流量系统挖掘机，其包括上述的电控系统。
与现有技术相比，本发明通过将手柄、倾角传感器的电信号通过CAN总线发送给控制器总成，控制器总成对这些信号进行综合，根据工作装置二自由度直线挖掘自动控制中动臂、斗杆的姿态角速率满足的定量关系，将直线挖掘铲斗轨迹控制转化为工作装置姿态角速率的匹配控制，将控制指令发送给DDV 伺服阀，DDV控制主阀芯换向，向油缸输出压力油，同时检测主阀芯位移并反馈于控制器形成闭环控制，从而实现工作臂的不同动作。在省去轨迹规划和轨迹到姿态角度的逆运算等复杂计算的同时也提高了控制的频带和响应速度，且便于加工、成本低，有利于实现批量化生产。
附图说明
图1是根据本发明的一个实施例的挖掘机电控系统示意图。
图2是根据本发明的一个实施例的一种挖掘机铲斗轨迹自动控制装置的方框图。
图3是根据本发明的一个实施例的挖掘机根据D-H坐标系法的规则建立的 4个坐标系的示意图。
图4是根据本发明的一个实施例的挖掘机电控系统中的铲斗自动直线挖掘的控制方法结构图。
图5是根据本发明的一个实施例的挖掘机斗杆阀芯位移随杆位移变化曲线图。
图6是根据本发明的一个实施例的利用神经网络算法确定所述动臂的控制阀阀芯位移的前馈控制量中，BP神经网络拓扑结构图。
图7示出了根据本发明的一个实施例的铲斗齿间中心的位置曲线图。
图8示出了根据本发明的一个实施例的铲斗齿间中心的位置误差。
图9示出了根据本发明的一个实施例的挖掘机进行100次挖掘试验，控制的最大单向误差示意图。
具体实施方式
为使本发明的目的、技术方案和优点更加清楚明白，以下结合具体实施例，并参照附图，对本发明进一步详细说明。
图1是根据本发明的一个实施例的挖掘机电控系统示意图，包括：
控制器总成，倾角传感器装置，控制阀装置；
其中，所述控制器总成与所述倾角传感器装置连接，接收来自所述倾角传感器的信号；所述控制器总成与挖掘机手柄相连接，接收来自挖掘机手柄位移量信号，以确定挖掘机斗杆的控制阀阀芯的位移量，从而控制挖掘机斗杆移动；所述控制器总成与所述控制阀连接，用于向所述控制阀发送控制信号，以控制所述控制阀控制所述挖掘机的铲斗油缸、斗杆油缸和动臂油缸移动；还包括位移传感器，所述位移传感器与所述控制阀装置和所述控制器总成连接，所述位移传感器监控所述控制阀系统的主阀芯的位移，并将位移信号反馈给所述控制器总成；
所述控制器总成还包括铲斗轨迹自动控制装置，铲斗轨迹自动控制装置与所述挖掘机手柄连接，所述铲斗轨迹自动控制装置能够根据挖掘机的动臂和斗杆的姿态角速率的定量关系，以及所述挖掘机手柄的位移量信号来实现挖掘机铲斗轨迹的直线轨迹自动控制。
目前针对铲斗自动轨迹控制的的现有技术中，都是将规划的铲斗轨迹转化为各工作装置的目标角度序列，进而通过工作装置的角度跟踪控制实现铲斗轨迹的跟踪控制。而本发明首次提出了根据工作装置二自由度直线挖掘自动控制中动臂、斗杆的姿态角速率满足的匹配关系，将直线挖掘铲斗轨迹控制转化为工作装置姿态角速率的匹配控制，通过将手柄、倾角传感器的电信号通过CAN 总线发送给控制器总成，控制器总成对这些信号进行综合，根据工作装置二自由度直线挖掘自动控制中动臂、斗杆的姿态角速率满足的定量关系，将直线挖掘铲斗轨迹控制转化为工作装置姿态角速率的匹配控制，将控制指令发送给DDV伺服阀，DDV控制主阀芯换向，向油缸输出压力油，同时检测主阀芯位移并反馈于控制器形成闭环控制，从而实现工作臂的不同动作，在省去轨迹规划和轨迹到姿态角度的逆运算等复杂计算的同时也提高了控制的频带和响应速度。
在本发明的一个实施例中，如图1所示，倾角传感器装置进一步包括：
铲斗姿态传感器，用于检测以铲斗绕斗杆的轴中心为坐标原点的坐标系中的铲斗姿态；
斗杆姿态传感器，用于检测以斗杆绕动臂的转轴中心为坐标原点的坐标系中的斗杆姿态；
动臂姿态传感器，用于检测以动臂绕车体的转轴中心为坐标原点的坐标系中的动臂姿态；
所述铲斗姿态传感器、斗杆姿态传感器、动臂姿态传感器分别与所述铲斗轨迹自动控制装置连接，用于将各自检测的独立坐标信号反馈给所述铲斗轨迹自动控制装置。
在本发明的一个实施例中，如图1所示，控制阀装置包括1级DDV阀和2 级多路主控阀，手柄、多功能仪表和倾角传感器的电信号通过CAN总线发送给控制器总成，控制器总成对这些信号进行综合处理后，将控制指令发送给DDV 伺服阀，DDV控制主阀芯换向，向油缸输出压力油，同时检测主阀芯位移并反馈于控制器形成闭环控制，从而实现工作臂的不同动作。
下面，结合图2示出了根据本公开的实施例的一种挖掘机铲斗轨迹自动控制装置的方框图。如图2所示，装置包括定量关系确定单元，用于根据挖掘机铲斗位置和挖掘机铲斗轨迹来确定挖掘机的动臂和斗杆的姿态角速率之间的定量关系；斗杆控制单元，根据挖掘机操纵手柄的位移量，确定所述斗杆的控制阀阀芯的位移量，控制所述斗杆移动；动臂姿态角速率确定单元，用于确定所述斗杆的姿态角速率，根据定量关系确定单元中确定的所述的定量关系，确定所述动臂的姿态角速率；动臂前馈控制单元，根据动臂姿态角速率确定单元确定的所述动臂的姿态角速率，确定所述动臂的控制阀阀芯位移的前馈控制量；动臂反馈控制单元，用于接收动臂姿态传感器反馈的动臂姿态角速率，根据动臂姿态角速率确定单元中确定的动臂姿态角速率和动臂姿态传感器反馈的动臂姿态角速率之间的差值，确定所述动臂的控制阀阀芯位移的反馈控制量；动臂控制单元，根据所述动臂的控制阀阀芯位移的前馈控制量和反馈控制量，确定所述动臂控制阀的阀芯位移控制量，控制所述动臂移动。
在本发明的一个实施例中，所述铲斗轨迹自动控制装置包括坐标转换单元，所述坐标转换单元将所述铲斗姿态传感器、斗杆姿态传感器、动臂姿态传感器各自的坐标系实时信号转换为以挖掘机车体回转中心为坐标原点的坐标系O0x0y0z0中的坐标信号。具体如下：
首先进行坐标系的转换，将挖掘机铲斗的齿间中心坐标转换为挖掘机车体回转中心的坐标，转换过程如下：
如图3所示，根据D-H坐标系法的规则建立4个坐标系，其中O0x0y0z0的原点O0位于挖掘机车体回转中心，x0与上车体的水平指向相同，z0沿车体回转轴，逆时针为正，O1x1y1z1的原点O1位于动臂绕车体的转轴中心，x1由动臂转轴指向斗杆绕动臂的转轴，z1沿动臂绕车体的转轴，O2x2y2z2的原点O2位于斗杆绕动臂的转轴中心，x2由斗杆转轴指向铲斗绕斗杆的转轴，z2沿斗杆绕动臂的转轴， O3x3y3z3的原点O3位于铲斗绕斗杆的轴中心，x3由原点指向铲斗的齿间中心，z3沿铲斗绕斗杆的转轴。各坐标系的变换可以用齐次变换矩阵
Figure BDA0002142898700000071
来表示，
Figure BDA0002142898700000072
O0x0y0z0到O1x1y1z1的齐次变换矩阵
Figure BDA0002142898700000073
可以表示为
Figure BDA0002142898700000074
其中，(a0，b0，c0)为O1在O0x0y0z0的位置矢量，
同理O1x1y1z1到O2x2y2z2的齐次变换矩阵
Figure BDA0002142898700000075
可以表示为
Figure BDA0002142898700000076
O2x2y2z2到O3x3y3z3的齐次变换矩阵
Figure BDA0002142898700000077
可以表示为
Figure BDA0002142898700000081
O0x0y0z0到O3x3y3z3的齐次变换矩阵
Figure BDA0002142898700000082
可以表示为
Figure BDA0002142898700000083
铲斗齿间中心在O3x3y3z3中的位置坐标为(xp3，yp3，zp3)，在O0x0y0z0中的位置坐标(xp0，yp0，zp0)可表示为：
Figure BDA0002142898700000084
在本发明的一个实施例中，所述铲斗轨迹自动控制装置进一步包括姿态角速率换算单元，所述态角速率换算单元根据坐标转换单元转换的铲斗的齿间中心的初始位置和实时位置，来确定挖掘机的动臂和斗杆的姿态角速率之间的定量关系。姿态角速率换算单元根据铲斗直线挖掘运动分析，获得动臂和斗杆的姿态角速率之间的定量关系：
O0x0y0z0坐标系中，铲斗初始位置为(ap0，bp0，cp0)，二自由度直线挖掘时xp3、 yp3、zp3、θ3为定值，根据式可知铲斗齿间yp0坐标保持不变，xp0和zp0坐标满足直线方程，定义一代价函数h(xp0，zp0)，
h(xp0，zp0)＝|zp0-tanμ·xp0+tanμ·ap0-cp0| (7)
其中μ为直线挖掘轨迹与x0轴的夹角。易知，铲斗初始位置的代价函数 h(ap0，cp0)等于0。为了使铲斗稳定地沿着预期的直线轨迹挖掘，铲斗实时位置的代价函数应恒等于0，于是有
Figure BDA0002142898700000085
把式(6)和式(7)代入式(8)展开可得
Figure BDA0002142898700000091
由上就是铲斗直线挖掘中动臂、斗杆的姿态角速率满足的定量关系。
下面，结合图4，对本发明一个实施例中铲斗自动直线挖掘的控制方法结构图进行说明。如图4所示，手柄位移信号Da通过挖掘速率指令环节得到不同挖掘速率对应的斗杆阀芯位移目标信号Xvc，驱动斗杆运动。斗杆姿态信号θ2、姿态角速率信号
Figure BDA0002142898700000092
挖掘角度信号μ以及动臂姿态信号θ1经动臂姿态角速率指令生成器的综合计算得到与斗杆姿态角速率匹配的动臂姿态角速率指令信号
Figure BDA0002142898700000093
在神经网络前馈控制器和PI控制器的共同作用下得到动臂阀芯位移目标信号Yvc，驱动动臂的运动。至此，实现了铲斗二自由度可变速率直线挖掘的自动控制。
下面结合图5对本发明的一个实施例中挖掘机挖掘速率指令进行说明：
二自由度直线挖掘时挖掘速率取决于斗杆运动速率。
斗杆油缸活塞伸出即阀芯位移xv＞0时，阀芯进油口和出油口的流量方程分别为：
Figure BDA0002142898700000094
Figure BDA0002142898700000095
式中，ps为系统压力，p1为无杆腔压力，p2为有杆腔压力，p0为系统回油压力。当系统负载一定时，ps p1 p2 p0的稳态值变化不大，根据式可知，阀芯位移越大，斗杆挖掘越快。因此挖掘速率指令设计可以转化为斗杆阀芯位移对手柄位移的梯度设计。按照小杆位移低灵敏度和大杆位移高灵敏度的要求，斗杆阀芯位移指令与杆位移成分段比例的变化关系，如图5所示。
动臂姿态是决定整个直线挖掘过程的关键，下面介绍一下动臂姿态角速率指令生成过程。
根据公式(9)，与斗杆姿态角速率匹配的动臂姿态角速率指令
Figure BDA0002142898700000096
可以表示为：
Figure BDA0002142898700000101
其中N(θ1，θ2)为
Figure BDA0002142898700000102
D(θ1，θ2)为
(xp3cos(θ1+θ2+θ3)-yp3 sin(θ1+θ2+θ3)+l1 cosθ1+l2 cos(θ1+θ2))
+tanμ(xp3 sin(θ1+θ2+θ3)+yp3 cos(θ1+θ2+θ3)+l2 sin(θ1+θ2)+l1 sinθ1)
在本发明的一个实施例中，为了得到动臂阀芯位移，采用神经网络前馈控制，根据动臂期望姿态角速率来求解动臂阀芯位移指令。正流量系统中，动臂阀芯流量同动臂阀芯位移是一个非线性关系，动臂和斗杆复合运动时彼此存在着速度干扰。因此，动臂姿态角速率同动臂阀芯位移是一个复杂非线性关系。由于BP神经网络可以逼近任意L2范数上的非线性函数，因此采用神经网络对动臂姿态角速率和动臂阀芯位移之间的非线性关系进行泛化。
在本发明的一个实施例中，如图6所示，采用三层BP神经网络系统，输入层由动臂姿态角速率
Figure BDA0002142898700000103
小臂阀芯位移Xv，泵压ps，小臂姿态θ2，动臂姿态θ1等5个节点组成，隐含层由5个节点，输出层1个节点，输出为动臂阀芯位移Yv。隐含层和输出层的激活函数f均为非对称S型函数。
通过复合操纵小臂和动臂，记录挖掘机稳态运动的数据，建立离线训练样本库。神经网络学习算法的步骤如下：
1)设置初始权值系数1w(0)和2w(0)；
2)根据训练样本库的输入输出对，计算网络的输出；
3)计算网络的目标函数；
4)判断学习是否结束；
5)根据梯度下降法对权值1w和2w进行调整。
对以上过程进行反复迭代，直到目标函数小于设定值，训练结束。将最终的1w和2w作为神经网络前馈控制器的权值参数。
由于神经网络前馈控制存在误差，为了获得更精确的结果，根据本发明的一个实施例，采用PI控制器来补偿因扰动和未建模动态引起的神经网络前馈控制的误差，计算公式为
Figure BDA0002142898700000104
kp为比例控制增益，取1～15，kI为积分控制增益，取0.05～0.15。
挖掘实验
将设计的控制方法通过车载控制器进行实施，在图1所示的电控系统中进行铲斗直线挖掘自动控制试验，其中姿态传感器的角度测量精度为0.1度，频率为200HZ，姿态角速率通过姿态角滤波得到。控制器中控制律的计算周期为 50ms，将挖掘机操纵到初始状态，通过斗杆按钮锁定初始位置，通过仪表设置挖掘角度，然后仅通过操纵斗杆手柄即可实现自动挖掘，操纵位移越大，挖掘速率越快。将控制器采集的姿态传感器数据代入公式(6)即可得到铲斗齿间中心的位置曲线如图7所示，位置误差见图8。
为了评价控制效果的一致性，在同一种工况下反复进行100次挖掘试验，控制的最大单向误差如图9所示，统计数据显示，自动挖掘的铲斗齿间位置最大误差4.99cm，最小误差3.51cm，平均误差4.03cm，标准差0.05cm。控制效果一致性很好，具有较强的工程实用性。
综上，本发明以挖掘机工作装置二自由度直线挖掘为例，基于代价函数最小理论获得铲斗直线挖掘自动控制中动臂、斗杆的姿态角速率满足的定量关系，从而将铲斗轨迹跟踪控制转化为工作装置姿态角速率的实时匹配控制，这样就无需进行轨迹规划和轨迹到姿态角度的逆运算等复杂计算，同时具有更高的控制频带和响应速度，会对误差进行更快的纠正，有利于提高控制精度。此外，针对正流量系统中阀芯流量同阀芯位移的非线性关系，应用BP神经网络对动臂姿态角速率和动臂阀芯位移之间的非线性关系进行泛化，实现了动臂的前馈控制。
试验结果表明，铲斗直线挖掘的控制精度可以达到5cm内，反复试验结果一致性好，具有较强的工程实用性。
尽管已经采用特定于结构特征和/或方法逻辑动作的语言描述了本主题，但是应当理解所附权利要求书中所限定的主题未必局限于上面描述的特定特征或动作。相反，上面所描述的特定特征和动作仅仅是实现权利要求书的示例形式，凡在本发明的精神和原则之内所作的任何修改、等同替换和改进等，均应包含在本发明的保护范围之内。以上所述仅是本发明的优选实施方式，应当指出，对于本技术领域的普通技术人员来说，在不脱离本发明技术原理的前提下，还可以做出若干改进和变型，这些改进和变型也应视为本发明的保护范围。

Claims (10)

1.一种挖掘机的电控系统，其特征在于，包括控制器总成，倾角传感器装置，控制阀装置；
其中，所述控制器总成与所述倾角传感器装置连接，接收来自所述倾角传感器的信号；所述控制器总成与挖掘机手柄相连接，接收来自挖掘机手柄位移量信号，以确定挖掘机斗杆的控制阀阀芯的位移量，从而控制挖掘机斗杆移动；所述控制器总成与所述控制阀连接，用于向所述控制阀发送控制信号，以控制所述控制阀控制所述挖掘机的铲斗油缸、斗杆油缸和动臂油缸移动；还包括位移传感器，所述位移传感器与所述控制阀装置和所述控制器总成连接，所述位移传感器监控所述控制阀系统的主阀芯的位移，并将位移信号反馈给所述控制器总成；
所述控制器总成还包括铲斗轨迹自动控制装置，铲斗轨迹自动控制装置与所述挖掘机手柄连接，所述铲斗轨迹自动控制装置能够根据挖掘机的动臂和斗杆的姿态角速率之间的定量关系，以及所述挖掘机手柄的位移量信号来实现挖掘机铲斗轨迹的直线轨迹自动控制；
其中，所述挖掘机的动臂和斗杆的姿态角速率之间的定量关系根据铲斗的齿间中心的初始位置和实时位置来确定。
2.如权利要求1所述的电控系统，其特征在于，所述铲斗轨迹自动控制装置包括：
定量关系确定单元，用于根据挖掘机铲斗位置和挖掘机铲斗轨迹来确定挖掘机的动臂和斗杆的姿态角速率之间的定量关系；
斗杆控制单元，根据挖掘机操纵手柄的位移量，确定所述斗杆的控制阀阀芯的位移量，控制所述斗杆移动；
动臂姿态角速率确定单元，用于确定所述斗杆的姿态角速率，根据定量关系确定单元确定的所述定量关系，确定所述动臂的姿态角速率；
动臂前馈控制单元，根据动臂姿态角速率确定单元确定的所述动臂的姿态角速率，确定所述动臂的控制阀阀芯位移的前馈控制量；
动臂反馈控制单元，用于接收动臂姿态传感器反馈的动臂姿态角速率，根据动臂姿态角速率确定单元中确定的动臂姿态角速率和动臂姿态传感器反馈的动臂姿态角速率之间的差值，确定所述动臂的控制阀阀芯位移的反馈控制量；
动臂控制单元，根据所述动臂的控制阀阀芯位移的前馈控制量和反馈控制量，确定所述动臂控制阀的阀芯位移控制量，控制所述动臂移动。
3.如权利要求1所述的电控系统，其特征在于，所述倾角传感器装置进一步包括：
铲斗姿态传感器，用于检测以铲斗绕斗杆的轴中心为坐标原点的坐标系中的铲斗姿态；
斗杆姿态传感器，用于检测以斗杆绕动臂的转轴中心为坐标原点的坐标系中的斗杆姿态；
动臂姿态传感器，用于检测以动臂绕车体的转轴中心为坐标原点的坐标系中的动臂姿态；
所述铲斗姿态传感器、斗杆姿态传感器、动臂姿态传感器分别与所述铲斗轨迹自动控制装置连接，用于将各自检测的独立坐标信号反馈给所述铲斗轨迹自动控制装置。
4.如权利要求3所述的电控系统，其特征在于，所述铲斗轨迹自动控制装置包括坐标转换单元，所述坐标转换单元将所述铲斗姿态传感器、斗杆姿态传感器、动臂姿态传感器各自的坐标系实时信号转换为以挖掘机车体回转中心为坐标原点的坐标系O0x0y0z0中的坐标信号。
5.如权利要求4所述的电控系统，其特征在于，所述铲斗轨迹自动控制装置进一步包括姿态角速率换算单元，所述姿态角速率换算单元根据坐标转换单元转换的铲斗的齿间中心的初始位置和实时位置，来确定挖掘机的动臂和斗杆的姿态角速率之间的定量关系。
6.如权利要求5所述的电控系统，其特征在于，通过使铲斗的齿间中心在O0x0y0z0坐标系中的实时位置的代价函数h(xp0，zp0)＝|zp0-tanμ·xp0+tanμ·ap0-cp0|＝0来确定挖掘机的动臂和斗杆的姿态角速率之间的定量关系，其中，μ为挖掘机铲斗的直线挖掘轨迹与O0x0y0z0中x0轴的夹角，所述x0轴与所述挖掘机的上车体的水平指向相同；(ap0，bp0，cp0)为铲斗齿间中心在所述O0x0y0z0坐标系中初始位置。
7.如权利要求1所述的电控系统，其特征在于，所述控制阀装置包括1级DDV阀和2级多路主控阀。
8.如权利要求1所述的电控系统，其特征在于，所述铲斗轨迹自动控制装置包括前馈控制单元，所述前馈控制单元与所述动臂的控制阀连接，利用神经网络算法对挖掘机动臂的控制阀阀芯位移进行前馈控制。
9.如权利要求1所述的电控系统，其特征在于，所述铲斗轨迹自动控制装置包括反馈控制单元，所述反馈控制单元与所述动臂的控制阀连接，利用比例积分算法对挖掘机动臂的控制阀阀芯位移的进行反馈控制。
10.一种正流量系统挖掘机，其特征在于，包括如权利要求1-9任一所述的电控系统。
CN201910674734.0A 2019-07-25 2019-07-25 一种挖掘机的电控系统及正流量系统挖掘机 Active CN110409546B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201910674734.0A CN110409546B (zh) 2019-07-25 2019-07-25 一种挖掘机的电控系统及正流量系统挖掘机

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201910674734.0A CN110409546B (zh) 2019-07-25 2019-07-25 一种挖掘机的电控系统及正流量系统挖掘机

Publications (2)

Publication Number Publication Date
CN110409546A CN110409546A (zh) 2019-11-05
CN110409546B true CN110409546B (zh) 2021-12-14

Family

ID=68363021

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201910674734.0A Active CN110409546B (zh) 2019-07-25 2019-07-25 一种挖掘机的电控系统及正流量系统挖掘机

Country Status (1)

Country Link
CN (1) CN110409546B (zh)

Families Citing this family (12)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR20210060866A (ko) * 2019-11-19 2021-05-27 두산인프라코어 주식회사 건설기계의 제어 방법 및 시스템
CN111042245B (zh) * 2019-12-31 2022-04-05 潍柴动力股份有限公司 一种挖掘机辅助作业控制方法及系统
CN112392080B (zh) * 2020-11-25 2022-07-29 三一重机有限公司 主动降低挖掘机动作冲击的装置、方法及挖掘机
CN112556649A (zh) * 2020-11-30 2021-03-26 徐州徐工挖掘机械有限公司 一种挖掘机倾角测量倾角修正方法、装置和倾角测量仪
CN112681443A (zh) * 2021-01-19 2021-04-20 山西创智卓越科技有限公司 一种挖掘机器人关节轨迹控制方法及控制系统
CN113739793B (zh) * 2021-08-17 2024-02-13 厦门大学 一种轮式装载机铲装作业轨迹采集方法和系统
CN113737885A (zh) * 2021-09-15 2021-12-03 北京拓疆者智能科技有限公司 挖掘机控制方法、装置、挖掘机及存储介质
CN114215500B (zh) * 2021-12-29 2024-01-23 徐州徐工挖掘机械有限公司 一种液压挖掘机螺旋钻杆机具控制系统及控制方法
CN114411840B (zh) * 2022-01-10 2024-02-02 上海华兴数字科技有限公司 平地控制方法、装置和挖掘机
CN114991236B (zh) * 2022-06-30 2024-05-28 徐州徐工矿业机械有限公司 一种挖掘机智能控制系统及工作装置轨迹规划控制方法
CN115387426B (zh) * 2022-08-29 2023-11-28 三一重机有限公司 作业机械的控制方法、装置、设备及作业机械
CN115354708A (zh) * 2022-09-16 2022-11-18 徐州徐工矿业机械有限公司 基于机器视觉的挖掘机铲斗自主挖掘识别控制系统及方法

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR20110037048A (ko) * 2009-10-05 2011-04-13 현대중공업 주식회사 휠로더의 붐 링크 상승속도 보상 장치 및 방법
CN102947513B (zh) * 2010-06-23 2015-07-08 斗山英维高株式会社 建筑机械的作业轨迹控制装置及其方法
CN105350595A (zh) * 2015-08-27 2016-02-24 中国航空工业集团公司西安飞行自动控制研究所 基于位置控制的挖掘机操纵装置
CN106945020A (zh) * 2017-05-18 2017-07-14 哈尔滨工业大学 一种空间双机械臂系统运动协调控制方法
CN109614743A (zh) * 2018-12-26 2019-04-12 广州海达安控智能科技有限公司 挖掘机及其铲斗定位方法、电子设备、存储介质
CN211113856U (zh) * 2019-07-25 2020-07-28 中国航空工业集团公司西安飞行自动控制研究所 一种挖掘机的电控系统及正流量系统挖掘机

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR20110037048A (ko) * 2009-10-05 2011-04-13 현대중공업 주식회사 휠로더의 붐 링크 상승속도 보상 장치 및 방법
CN102947513B (zh) * 2010-06-23 2015-07-08 斗山英维高株式会社 建筑机械的作业轨迹控制装置及其方法
CN105350595A (zh) * 2015-08-27 2016-02-24 中国航空工业集团公司西安飞行自动控制研究所 基于位置控制的挖掘机操纵装置
CN106945020A (zh) * 2017-05-18 2017-07-14 哈尔滨工业大学 一种空间双机械臂系统运动协调控制方法
CN109614743A (zh) * 2018-12-26 2019-04-12 广州海达安控智能科技有限公司 挖掘机及其铲斗定位方法、电子设备、存储介质
CN211113856U (zh) * 2019-07-25 2020-07-28 中国航空工业集团公司西安飞行自动控制研究所 一种挖掘机的电控系统及正流量系统挖掘机

Also Published As

Publication number Publication date
CN110409546A (zh) 2019-11-05

Similar Documents

Publication Publication Date Title
CN110409546B (zh) 一种挖掘机的电控系统及正流量系统挖掘机
CN110409528B (zh) 一种挖掘机铲斗轨迹自动控制装置、方法和计算机可读存储介质
CN211113856U (zh) 一种挖掘机的电控系统及正流量系统挖掘机
CN107882103B (zh) 一种挖掘机三维姿态显示及远程自动控制系统
Egli et al. A general approach for the automation of hydraulic excavator arms using reinforcement learning
CN100464036C (zh) 用于液压挖掘机工作装置的轨迹控制系统及方法
US20170328031A1 (en) Operation identification of a work machine
Sotiropoulos et al. A model-free extremum-seeking approach to autonomous excavator control based on output power maximization
CN109296019A (zh) 挖掘机臂运动控制方法、系统及装置
CN115157238A (zh) 一种多自由度机器人动力学建模和轨迹跟踪方法
CN107709672A (zh) 工程机械
Bo et al. High performance control of hydraulic excavator based on fuzzy-PI soft-switch controller
CN112925208A (zh) 一种数据驱动的水井钻机电液伺服系统扰动补偿方法
CN109375584A (zh) 臂架关节控制方法及系统及包含该系统的工程机械
CN112681443A (zh) 一种挖掘机器人关节轨迹控制方法及控制系统
Kang et al. Path tracking for a hydraulic excavator utilizing proportional-derivative and linear quadratic control
Maeda Learning and reacting with inaccurate prediction: applications to autonomous excavation
Qin et al. An adaptive robust impedance control considering energy-saving of hydraulic excavator boom and stick systems
CN114351785B (zh) 一种基于强化学习的液压挖掘机系统流量匹配优化方法
JPS6234888B2 (zh)
CN215888415U (zh) 一种挖掘机器人关节轨迹控制系统
CN115544768A (zh) 一种自主挖掘作业轨迹生成方法及系统
Wind et al. Design of an adaptive velocity controller for a hydraulic mini excavator using a moving-horizon-estimator
Liu et al. Review on control systems and control strategies for excavators
CN117739991B (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