CN106836364B - 智能挖掘机的自动控制系统及最优轨迹规划方法 - Google Patents

智能挖掘机的自动控制系统及最优轨迹规划方法 Download PDF

Info

Publication number
CN106836364B
CN106836364B CN201710031640.2A CN201710031640A CN106836364B CN 106836364 B CN106836364 B CN 106836364B CN 201710031640 A CN201710031640 A CN 201710031640A CN 106836364 B CN106836364 B CN 106836364B
Authority
CN
China
Prior art keywords
excavation
processor
excavated
sensor
excavator
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
CN201710031640.2A
Other languages
English (en)
Other versions
CN106836364A (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.)
Dalian University of Technology
Original Assignee
Dalian University of Technology
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 Dalian University of Technology filed Critical Dalian University of Technology
Priority to CN201710031640.2A priority Critical patent/CN106836364B/zh
Publication of CN106836364A publication Critical patent/CN106836364A/zh
Application granted granted Critical
Publication of CN106836364B publication Critical patent/CN106836364B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

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/2041Automatic repositioning of implements, i.e. memorising determined positions of the implement
    • 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/22Hydraulic or pneumatic drives
    • E02F9/2221Control of flow rate; Load sensing arrangements

Landscapes

  • Engineering & Computer Science (AREA)
  • Mining & Mineral Resources (AREA)
  • Civil Engineering (AREA)
  • General Engineering & Computer Science (AREA)
  • Structural Engineering (AREA)
  • Physics & Mathematics (AREA)
  • Fluid Mechanics (AREA)
  • Operation Control Of Excavators (AREA)
  • Earth Drilling (AREA)

Abstract

本发明公开了一种智能挖掘机的自动控制系统及最优轨迹规划方法,所述的系统包括数据采集与执行模块、网络、处理器和存储装置,所述的数据采集与执行模块包括3D扫描仪、功率传感器、接近传感器、位移传感器、角度传感器、扭矩传感器、信息装置、控制器、处理器、存储装置和无线收发器。由于本发明采用了3D扫描仪确定待挖掘物料表面的轮廓,并通过处理器得到轮廓的坐标矩阵,从而对料堆进行了精确地建模,实现了对挖掘复杂料堆表面载荷的精确预测。由于本发明通过信息装置及处理器对挖掘机挖掘过程中的控制参数进行了优化,实现了挖掘载荷最小,挖掘能耗最低的目的。本发明改进了载荷预测算法的准确性,实现了对挖掘载荷的精确预测。

Description

智能挖掘机的自动控制系统及最优轨迹规划方法
技术领域
本发明涉及挖掘机的控制技术,特别是一种智能挖掘机的最优轨迹规划方法。
背景技术
操作诸如大型矿用挖掘机的大型机器较为复杂,并且不同操作人员的操作技术与操作习惯具有差异而导致操作不能达到统一标准化,所以人工操作大型矿用挖掘机效率低且不稳定。
另外,目前对料堆的确定普遍是将扫描后的料堆拟合成一个固定堆积角的斜面,并没有考虑到料堆不同位置的起伏与其复杂性,这就可能导致包括挖掘不能满斗、挖掘阻力过大、挖掘能耗过高和对铲斗及斗齿磨损过快等情况的发生。
另外,挖掘载荷预测方面一直以来都缺少一个相对完善的数学解析式。由于物料的复杂性,不同的工况的物料参数(如内摩擦角、外摩擦角、粘度、物料破坏面与表面夹角等)有着较大的差异并且难以测量,这对预测的准确性造成了很大的影响。
发明内容
为解决现有技术存在的上述问题,本发明要设计一种无需人员操作、能确定当前工况下最优挖掘轨迹并且能根据实际挖掘过程不断改善载荷预测算法的智能挖掘机的自动控制系统及最优轨迹规划方法。
为了实现上述目的,本发明的技术方案如下:智能挖掘机的自动控制系统,包括数据采集与执行模块、网络、处理器和存储装置,所述的数据采集与执行模块、网络、处理器和存储装置通过数据线双向串联;所述的数据采集与执行模块安装在挖掘机上,所述的处理器和存储装置设置在挖掘机外的控制室内;
所述的数据采集与执行模块包括3D扫描仪、功率传感器、接近传感器、位移传感器、角度传感器、扭矩传感器、信息装置、控制器和无线收发器,所述的3D扫描仪、功率传感器、接近传感器和位移传感器分别与信息装置连接,所述的信息装置分别与控制器和无线收发器连接,所述的无线收发器与网络连接;
所述的3D扫描仪用于确定待挖掘物料表面的轮廓,形成待挖掘的物料表面轮廓数据;
功率传感器用于测量各工作电机在挖掘过程中的所消耗的功和功率;
接近传感器用于获得铲斗及挖掘机机架的相对位置;
位移传感器和角度传感器分别用于测量斗杆的伸缩位移及其转角,从而确定出铲斗的空间坐标;
扭矩传感器用于测量各工作电机挖掘过程中输出的扭矩;
所述的处理器处理接收到的信息,并根据所接收到的信息对挖掘轨迹及载荷预测模型进行优化,并将优化后的挖掘程序通过网络发送到信息装置中,将新建的载荷预测模型信息存储在存储装置中。
进一步地,所述的网络包括无连接网络、虚拟网络、无线电路网络、电话网络、PTOS网络、专用网络、非PTOS网络、PSTN网络、非PSTN网络、电缆网络、人造卫星网络、微波网络、双绞线网络、IEEEE 802.03网络、以太网络、蜂窝式网络、令牌环网络、局域网络、广域网络、DSL网络、IP网络、因特网、内联网、无线网络、超宽带网络、公共网络、Wi-Fi网络、蓝牙网络、机场网络、电路交换网络、分组交换网络、IEEE 802.11网络、IEEE 802.11b网络、IEEE802.11g网络、X-10网络或电源网络。
智能挖掘机的最优轨迹规划方法,包括以下步骤:
A、启动智能挖掘机上的数据采集与执行模块;
B、数据采集与执行模块接收处理器发送来的挖掘计划,挖掘计划包括挖掘料堆位置和需要挖掘的物料体积;
C、3D扫描仪开始扫描料堆,读取采掘坐标、采掘地形、采掘表面的数字图像;
D、根据由智能挖掘机所接受的挖掘计划重新定位挖掘机;并通过处理器将采集的3D轮廓数据点进行细分,在铲斗挖掘宽度范围内等分成多个数组,将多个数组形成多个料堆经度的轮廓线,自动处理计算得到多个挖掘轨迹,并使其满足铲斗满斗率约束、斗杆最大伸长量约束、出料高度约束、最大挖掘高度约束和无啃底约束,确定出该工况下的最优挖掘轨迹。处理器将最优挖掘轨迹编译成挖掘程序,并发送给信息装置;
E、信息装置获取接近传感器、位移传感器和角度传感器的信息,并与所接收到的挖掘程序进行对比,从而判断当前铲斗是否在适当的位置,若不在适当位置,则转到步骤F;若在适当位置,则转到步骤G;
F、控制器使铲斗调整到合适的位置;
G、控制器执行挖掘机的例行挖掘程序;
H、在挖掘机的实际挖掘过程中,功率传感器、接近传感器和位移传感器将实际挖掘过程中所得到的信息反馈给处理器;
I、重新改进挖掘的载荷预测与优化方法;比较执行最优挖掘程序的结果和实际挖掘的结果;如果最优挖掘程序的结果与实际挖掘的结果相差较大,则修正所存储的载荷预测方法,并通过优化的方法重新对料堆的物理参数进行标定。
J、处理器根据扭矩传感器得到的平衡位置时的扭矩计算出已挖掘的物料质量,根据物料容重得到已挖掘物料体积,从而判断是否完成挖掘计划。若没有完成,转步骤C。若已完成,则结束此次挖掘并等待接收新的挖掘计划。
进一步地,步骤D所述的最优挖掘轨迹的确定方法包括以下步骤:
D1、由3D扫描仪得到料堆所有对应节点的坐标p的矩阵如下:
pmn=pmn(x,y)
式中,i为扫描矩阵的最大行数,j为扫描矩阵的最大列数,m,n分别为矩阵的行和列范围内的任意数值,x,y为该点所对应的二维坐标;
D2、处理器通过改变预计控制参数得到预计挖掘轨迹s对应的坐标矩阵;
[s1 s2…sj]
sn=sn(x,y)
D3、根据以上两个矩阵得到不同料堆扫描经度剖面位置处铲斗挖掘的阴影面积:
D4、根据不同料堆扫描经度剖面位置处铲斗挖掘的阴影面积得到其总的挖掘体积:
其中:V为总挖掘体积,B为铲斗宽度。
切向挖掘阻力Fτ和法向挖掘阻力Fn通过经验公式进行初步的预测:
其中:σm为挖掘比阻力,φ为内摩擦角,δ为外摩擦角,c为粘度,ρ为料堆破坏面与料堆表面夹角,λ为料堆堆积密度,C为挖掘深度,ζ为比例系数。
D5、根据步骤D1-D4的计算,对挖掘轨迹进行优化,具体优化方法如下:
findx=[x1,x2,x3]T=[vτ,vn,L3]T
s.t.Vmin≤V≤Vmax
lg≤c1 (lg=lg0+vc·tc)
θp1≥θ1p1(t,v,a2)]
p1max≤hc
dlp≥0 [dlp(L3,t,v)]
其中:lg为斗杆最大伸长量约束,θp1为出料高度约束,p1max为最大挖掘高度约束,dlp为无啃底约束。设计变量为挖掘机的控制参数,分别为切向速度vτ和法向速度vn,通过改变这两个速度来改变挖掘轨迹。优化目标为单位有效挖掘质量所需能耗其中m为铲斗内物料的质量。
对上式进行优化计算,确定最优挖掘轨迹。
进一步地,步骤I所述的载荷预测方法的修正方法如下:在经过实际挖掘过程后,安装在挖掘机上的功率传感器、位移传感器、角度传感器和扭矩传感器得到实测挖掘载荷Fprac,此时处理器对比实测挖掘载荷Fprac与预测挖掘载荷F,若误差大于临界值,则对挖掘载荷预测方法进行修正,具体方法如下:
find x=[x1,x2,x3,x4,x5,x6]=[φ,δ,c,ρ,ζ,λ]
Min ΔF=|Fprac-F|
上式为根据实际挖掘载荷对预测挖掘载荷中的参数进行优化,参数分别为内摩擦角φ、外摩擦角δ、粘度c、料堆破坏面与料堆表面夹角ρ和料堆堆积密度λ,ζ为比例系数;优化目标为实际挖掘载荷与预测挖掘载荷之差的绝对值,使其最小,则得到的物料参数与实际越贴近;约束为料堆物理参数的下界,为料堆物理参数的上界;之后再将优化所得到的结果发送到存储装置当中,作为下次挖掘时载荷预测的参数。
进一步地,步骤D5所述的优化计算的方法为单纯形法、梯度下降法、遗传算法、蚁群法、退火法、禁忌搜索法、粒子群算法、梯度投影法或罚函数法。
与现有技术相比,本发明具有以下有益效果:
1、由于本发明采用了3D扫描仪确定待挖掘物料表面的轮廓,并通过处理器得到轮廓的坐标矩阵,从而对料堆进行了精确地建模,实现了对挖掘复杂料堆表面载荷的精确预测。
2、由于本发明通过信息装置及处理器对挖掘机挖掘过程中的控制参数进行了优化,实现了挖掘载荷最小,挖掘能耗最低的目的。
3、由于本发明通过挖掘过程中功率传感器、位移传感器、角度传感器和扭矩传感器对信息装置的反馈,处理器进一步的对原有的载荷预测算法进行优化及定义,从而改进载荷预测算法的准确性,进一步的实现了对挖掘载荷的精确预测。也使得智能挖掘机可以自适应地学习并可以自适应地改善性能和准确性。
附图说明
图1是本发明的方法流程图;
图2是本发明的扫描料堆矩阵示意图;
图3是本发明的挖掘体积计算剖面示意图;
图4是本发明的组成示意图。
图中:1、3D扫描仪,2、功率传感器,3、接近传感器,4、位移传感器,5、角度传感器,6、扭矩传感器,7、信息装置,8、控制器,9、无线收发器,10、网络,11、处理器,12、存储装置。
具体实施方式
下面结合附图对本发明进行进一步地描述。如图1-4所示,智能挖掘机的自动控制系统,包括数据采集与执行模块、网络10、处理器11和存储装置12,所述的数据采集与执行模块、网络10、处理器11和存储装置12通过数据线双向串联;所述的数据采集与执行模块安装在挖掘机上,所述的处理器11和存储装置12设置在挖掘机外的控制室内;
所述的数据采集与执行模块包括3D扫描仪1、功率传感器2、接近传感器3、位移传感器4、角度传感器5、扭矩传感器6、信息装置7、控制器8和无线收发器9,所述的3D扫描仪1、功率传感器2、接近传感器3和位移传感器4分别与信息装置7连接,所述的信息装置7分别与控制器8和无线收发器9连接,所述的无线收发器9与网络10连接;
所述的3D扫描仪1用于确定待挖掘物料表面的轮廓,形成待挖掘的物料表面轮廓数据;
功率传感器2用于测量各工作电机在挖掘过程中的所消耗的功和功率;
接近传感器3用于获得铲斗及挖掘机机架的相对位置;
位移传感器4和角度传感器5分别用于测量斗杆的伸缩位移及其转角,从而确定出铲斗的空间坐标;
扭矩传感器6用于测量各工作电机挖掘过程中输出的扭矩;
所述的处理器11处理接收到的信息,并根据所接收到的信息对挖掘轨迹及载荷预测模型进行优化,并将优化后的挖掘程序通过网络10发送到信息装置7中,将新建的载荷预测模型信息存储在存储装置12中。
进一步地,所述的网络10包括无连接网络、虚拟网络、无线电路网络、电话网络、PTOS网络、专用网络、非PTOS网络、PSTN网络、非PSTN网络、电缆网络、人造卫星网络、微波网络、双绞线网络、IEEEE 802.03网络、以太网络、蜂窝式网络、令牌环网络、局域网络、广域网络、DSL网络、IP网络、因特网、内联网、无线网络、超宽带网络、公共网络、Wi-Fi网络、蓝牙网络、机场网络、电路交换网络、分组交换网络、IEEE 802.11网络、IEEE 802.11b网络、IEEE802.11g网络、X-10网络或电源网络。
智能挖掘机的最优轨迹规划方法,包括以下步骤:
A、启动智能挖掘机上的数据采集与执行模块;
B、数据采集与执行模块接收处理器11发送来的挖掘计划,挖掘计划包括挖掘料堆位置和需要挖掘的物料体积;
C、3D扫描仪1开始扫描料堆,读取采掘坐标、采掘地形、采掘表面的数字图像;
D、根据由智能挖掘机所接受的挖掘计划重新定位挖掘机;并通过处理器11将采集的3D轮廓数据点进行细分,在铲斗挖掘宽度范围内等分成多个数组,将多个数组形成多个料堆经度的轮廓线,自动处理计算得到多个挖掘轨迹,并使其满足铲斗满斗率约束、斗杆最大伸长量约束、出料高度约束、最大挖掘高度约束和无啃底约束,确定出该工况下的最优挖掘轨迹。处理器11将最优挖掘轨迹编译成挖掘程序,并发送给信息装置7;
E、信息装置7获取接近传感器3、位移传感器4和角度传感器5的信息,并与所接收到的挖掘程序进行对比,从而判断当前铲斗是否在适当的位置,若不在适当位置,则转到步骤F;若在适当位置,则转到步骤G;
F、控制器8使铲斗调整到合适的位置;
G、控制器8执行挖掘机的例行挖掘程序;
H、在挖掘机的实际挖掘过程中,功率传感器2、接近传感器3和位移传感器4将实际挖掘过程中所得到的信息反馈给处理器11;
I、重新改进挖掘的载荷预测与优化方法;比较执行最优挖掘程序的结果和实际挖掘的结果;如果最优挖掘程序的结果与实际挖掘的结果相差较大,则修正所存储的载荷预测方法,并通过优化的方法重新对料堆的物理参数进行标定。
J、处理器11根据扭矩传感器6得到的平衡位置时的扭矩计算出已挖掘的物料质量,根据物料容重得到已挖掘物料体积,从而判断是否完成挖掘计划。若没有完成,转步骤C。若已完成,则结束此次挖掘并等待接收新的挖掘计划。
图2-3是基于3D扫描料堆的轨迹优化的示意图,该示意图包括扫描料堆3D坐标图及在斗宽范围内,不同位置的挖掘面积示意图。步骤D所述的最优挖掘轨迹的确定方法包括以下步骤:
D1、由3D扫描仪1得到料堆所有对应节点的坐标p的矩阵如下:
pmn=pmn(x,y)
式中,i为扫描矩阵的最大行数,j为扫描矩阵的最大列数,m,n分别为矩阵的行和列范围内的任意数值,x,y为该点所对应的二维坐标;
D2、处理器11通过改变预计控制参数得到预计挖掘轨迹s对应的坐标矩阵;
[s1 s2…sj]
sn=sn(x,y)
D3、根据以上两个矩阵得到图3所示不同料堆扫描经度剖面位置处铲斗挖掘的阴影面积:
D4、根据不同料堆扫描经度剖面位置处铲斗挖掘的阴影面积得到其总的挖掘体积:
其中:V为总挖掘体积,B为铲斗宽度。
切向挖掘阻力Fτ和法向挖掘阻力Fn通过经验公式进行初步的预测:
其中:σm为挖掘比阻力,φ为内摩擦角,δ为外摩擦角,c为粘度,ρ为料堆破坏面与料堆表面夹角,λ为料堆堆积密度,C为挖掘深度,ζ为比例系数。
D5、根据步骤D1-D4的计算,对挖掘轨迹进行优化,具体优化方法如下:
findx=[x1,x2,x3]T=[vτ,vn,L3]T
s.t.Vmin≤V≤Vmax
lg≤c1 (lg=lg0+vc·tc)
θp1≥θ1p1(t,v,a2)]
p1max≤hc
dlp≥0 [dlp(L3,t,v)]
其中:V为满斗率约束,lg为斗杆最大伸长量约束,θp1为出料高度约束,p1max为最大挖掘高度约束,dlp为无啃底约束。设计变量为挖掘机的控制参数,分别为切向速度vτ和法向速度vn,通过改变这两个速度来改变挖掘轨迹。优化目标为单位有效挖掘质量所需能耗其中m为铲斗内物料的质量。
对上式进行优化计算,确定最优挖掘轨迹。
进一步地,步骤I所述的载荷预测方法的修正方法如下:在经过实际挖掘过程后,安装在挖掘机上的功率传感器2、位移传感器4、角度传感器5和扭矩传感器6得到实测挖掘载荷Fprac,此时处理器11对比实测挖掘载荷Fprac与预测挖掘载荷F,若误差大于临界值,则对挖掘载荷预测方法进行修正,具体方法如下:
findx=[x1,x2,x3,x4,x5,x6]=[φ,δ,c,ρ,ζ,λ]
Min ΔF=|Fprac-F|
上式为根据实际挖掘载荷对预测挖掘载荷中的参数进行优化,参数分别为内摩擦角φ、外摩擦角δ、粘度c、料堆破坏面与料堆表面夹角ρ和料堆堆积密度λ,ζ为比例系数;优化目标为实际挖掘载荷与预测挖掘载荷之差的绝对值,使其最小,则得到的物料参数与实际越贴近;约束为料堆物理参数的下界,为料堆物理参数的上界;之后再将优化所得到的结果发送到存储装置12当中,作为下次挖掘时载荷预测的参数。
进一步地,步骤D5所述的优化计算的方法为单纯形法、梯度下降法、遗传算法、蚁群法、退火法、禁忌搜索法、粒子群算法、梯度投影法或罚函数法。
本发明不局限于本实施例,任何在本发明披露的技术范围内的等同构思或者改变,均列为本发明的保护范围。

Claims (2)

1.智能挖掘机的最优轨迹规划方法,所述的智能挖掘机的自动控制系统包括数据采集与执行模块、网络(10)、处理器(11)和存储装置(12),所述的数据采集与执行模块、网络(10)、处理器(11)和存储装置(12)通过数据线双向串联;所述的数据采集与执行模块安装在挖掘机上,所述的处理器(11)和存储装置(12)设置在挖掘机外的控制室内;
所述的数据采集与执行模块包括3D扫描仪(1)、功率传感器(2)、接近传感器(3)、位移传感器(4)、角度传感器(5)、扭矩传感器(6)、信息装置(7)、控制器(8)和无线收发器(9),所述的3D扫描仪(1)、功率传感器(2)、接近传感器(3)和位移传感器(4)分别与信息装置(7)连接,所述的信息装置(7)分别与控制器(8)和无线收发器(9)连接,所述的无线收发器(9)与网络(10)连接;
所述的3D扫描仪(1)用于确定待挖掘物料表面的轮廓,形成待挖掘的物料表面轮廓数据;
功率传感器(2)用于测量各工作电机在挖掘过程中的所消耗的功和功率;
接近传感器(3)用于获得铲斗及挖掘机机架的相对位置;
位移传感器(4)和角度传感器(5)分别用于测量斗杆的伸缩位移及其转角,从而确定出铲斗的空间坐标;
扭矩传感器(6)用于测量各工作电机挖掘过程中输出的扭矩;
所述的处理器(11)处理接收到的信息,并根据所接收到的信息对挖掘轨迹及载荷预测模型进行优化,并将优化后的挖掘程序通过网络(10)发送到信息装置(7)中,将新建的载荷预测模型信息存储在存储装置(12)中;
其特征在于:最优轨迹规划方法包括以下步骤:
A、启动智能挖掘机上的数据采集与执行模块;
B、数据采集与执行模块接收处理器(11)发送来的挖掘计划,挖掘计划包括挖掘料堆位置和需要挖掘的物料体积;
C、3D扫描仪(1)开始扫描料堆,读取采掘坐标、采掘地形、采掘表面的数字图像;
D、根据由智能挖掘机所接受的挖掘计划重新定位挖掘机;并通过处理器(11)将采集的3D轮廓数据点进行细分,在铲斗挖掘宽度范围内等分成多个数组,将多个数组形成多个料堆经度的轮廓线,自动处理计算得到多个挖掘轨迹,并使其满足铲斗满斗率约束、斗杆最大伸长量约束、出料高度约束、最大挖掘高度约束和无啃底约束,确定出该工况下的最优挖掘轨迹;处理器(11)将最优挖掘轨迹编译成挖掘程序,并发送给信息装置(7);
所述的最优挖掘轨迹的确定方法包括以下步骤:
D1、由3D扫描仪(1)得到料堆所有对应节点的坐标p的矩阵如下:
pmn=pmn(x,y)
式中,i为扫描矩阵的最大行数,j为扫描矩阵的最大列数,m,n分别为矩阵的行和列范围内的任意数值,x,y为该点所对应的二维坐标;
D2、处理器(11)通过改变预计控制参数得到预计挖掘轨迹s对应的坐标矩阵;
[s1 s2 … sj]
sn=sn(x,y)
D3、根据以上两个矩阵得到不同料堆扫描经度剖面位置处铲斗挖掘的阴影面积:
D4、根据不同料堆扫描经度剖面位置处铲斗挖掘的阴影面积得到其总的挖掘体积:
其中:V为总挖掘体积,B为铲斗宽度;
切向挖掘阻力Fτ和法向挖掘阻力Fn通过经验公式进行初步的预测:
其中:σm为挖掘比阻力,φ为内摩擦角,δ为外摩擦角,c为粘度,ρ为料堆破坏面与料堆表面夹角,λ为料堆堆积密度,C为挖掘深度,ζ为比例系数;
D5、根据步骤D1-D4的计算,对挖掘轨迹进行优化,具体优化方法如下:
findx=[x1,x2,x3]T=[vτ,vn,L3]T
s.t.Vmin≤V≤Vmax
lg≤c1 (lg=lg0+vc·tc)
θp1≥θ1p1(t,v,a2)]
p1max≤hc
dlp≥0 [dlp(L3,t,v)]
其中:lg为斗杆最大伸长量约束,θp1为出料高度约束,p1max为最大挖掘高度约束,dlp为无啃底约束;设计变量为挖掘机的控制参数,分别为切向速度vτ和法向速度vn,通过改变这两个速度来改变挖掘轨迹;优化目标为单位有效挖掘质量所需能耗其中m为铲斗内物料的质量;
对上式进行优化计算,确定最优挖掘轨迹;
E、信息装置(7)获取接近传感器(3)、位移传感器(4)和角度传感器(5)的信息,并与所接收到的挖掘程序进行对比,从而判断当前铲斗是否在适当的位置,若不在适当位置,则转到步骤F;若在适当位置,则转到步骤G;
F、控制器(8)使铲斗调整到合适的位置;
G、控制器(8)执行挖掘机的例行挖掘程序;
H、在挖掘机的实际挖掘过程中,功率传感器(2)、接近传感器(3)和位移传感器(4)将实际挖掘过程中所得到的信息反馈给处理器(11);
I、重新改进挖掘的载荷预测与优化方法;比较执行最优挖掘程序的结果和实际挖掘的结果;如果最优挖掘程序的结果与实际挖掘的结果相差较大,则修正所存储的载荷预测方法,并通过优化的方法重新对料堆的物理参数进行标定;
所述的载荷预测方法的修正方法如下:在经过实际挖掘过程后,安装在挖掘机上的功率传感器(2)、位移传感器(4)、角度传感器(5)和扭矩传感器(6)得到实测挖掘载荷Fprac,此时处理器(11)对比实测挖掘载荷Fprac与预测挖掘载荷F,若误差大于临界值,则对挖掘载荷预测方法进行修正,具体方法如下:
find x=[x1,x2,x3,x4,x5,x6]=[φ,δ,c,ρ,ζ,λ]
MinΔF=|Fprac-F|
上式为根据实际挖掘载荷对预测挖掘载荷中的参数进行优化,参数分别为内摩擦角φ、外摩擦角δ、粘度c、料堆破坏面与料堆表面夹角ρ和料堆堆积密度λ,ζ为比例系数;优化目标为实际挖掘载荷与预测挖掘载荷之差的绝对值,使其最小,则得到的物料参数与实际越贴近;约束为料堆物理参数的下界,为料堆物理参数的上界;之后再将优化所得到的结果发送到存储装置(12)当中,作为下次挖掘时载荷预测的参数;
J、处理器(11)根据扭矩传感器(6)得到的平衡位置时的扭矩计算出已挖掘的物料质量,根据物料容重得到已挖掘物料体积,从而判断是否完成挖掘计划;若没有完成,转步骤C;若已完成,则结束此次挖掘并等待接收新的挖掘计划。
2.根据权利要求1所述的智能挖掘机的最优轨迹规划方法,其特征在于:步骤D5所述的优化计算的方法为单纯形法、梯度下降法、遗传算法、蚁群法、退火法、禁忌搜索法、粒子群算法、梯度投影法或罚函数法。
CN201710031640.2A 2017-01-17 2017-01-17 智能挖掘机的自动控制系统及最优轨迹规划方法 Active CN106836364B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201710031640.2A CN106836364B (zh) 2017-01-17 2017-01-17 智能挖掘机的自动控制系统及最优轨迹规划方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201710031640.2A CN106836364B (zh) 2017-01-17 2017-01-17 智能挖掘机的自动控制系统及最优轨迹规划方法

Publications (2)

Publication Number Publication Date
CN106836364A CN106836364A (zh) 2017-06-13
CN106836364B true CN106836364B (zh) 2019-02-12

Family

ID=59123155

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201710031640.2A Active CN106836364B (zh) 2017-01-17 2017-01-17 智能挖掘机的自动控制系统及最优轨迹规划方法

Country Status (1)

Country Link
CN (1) CN106836364B (zh)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2020229278A1 (de) * 2019-05-16 2020-11-19 Robert Bosch Gmbh Verfahren zur berechnung eines aushubvolumens

Families Citing this family (12)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN108678049B (zh) * 2018-05-28 2021-04-23 柳州柳工挖掘机有限公司 挖掘机斗杆挖掘阻力优化控制方法及控制系统
CN108898183A (zh) * 2018-07-02 2018-11-27 中国人民解放军战略支援部队信息工程大学 一种巡检路线制定方法及装置
CN109814559A (zh) * 2019-01-25 2019-05-28 北京百度网讯科技有限公司 用于控制挖掘机挖掘的方法和装置
CN109801366A (zh) * 2019-01-25 2019-05-24 北京百度网讯科技有限公司 用于选取目标挖掘点的方法和装置
CN109903337B (zh) * 2019-02-28 2022-06-14 北京百度网讯科技有限公司 用于确定挖掘机的铲斗的位姿的方法和装置
CN110209062B (zh) * 2019-06-04 2022-11-04 三一重机有限公司 挖掘机装卸控制方法及装置
CN110455290B (zh) * 2019-07-17 2020-12-08 爱克斯维智能科技(苏州)有限公司 一种智能液压挖掘机的最优轨迹规划方法
CN112064700B (zh) * 2020-09-18 2022-05-31 广西科技大学 一种装载机最佳铲装轨迹匹配方法
CN112211248A (zh) * 2020-10-26 2021-01-12 吉林大学 一种装载机及其自主铲装控制方法
CN113833038B (zh) * 2021-09-01 2022-10-11 广西科技大学 一种面向自动铲装的装载机铲装轨迹规划方法
CN114543666B (zh) * 2022-01-20 2022-11-29 大连理工大学 一种基于矿场环境感知的堆料面预测方法
CN115506431A (zh) * 2022-09-16 2022-12-23 福建晋工新能源科技有限公司 自动铲料系统和自动铲料系统自动铲料控制方法

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US4838755A (en) * 1987-02-19 1989-06-13 Deere & Company Automatic engine control for an excavator
CN2900632Y (zh) * 2006-03-17 2007-05-16 中南大学 机电一体化挖掘机
CN101413279A (zh) * 2008-11-29 2009-04-22 湖南山河智能机械股份有限公司 机电一体化挖掘装载机及控制方法
CN102691321A (zh) * 2011-12-08 2012-09-26 上海三一重机有限公司 一种实现铲斗瞬时挖掘转角和挖掘力的优化控制系统及方法
CN102947513A (zh) * 2010-06-23 2013-02-27 斗山英维高株式会社 建筑机械的作业轨迹控制装置及其方法
CN104662232A (zh) * 2012-09-25 2015-05-27 沃尔沃建造设备有限公司 用于施工机械的自动整平系统及其控制方法

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US4838755A (en) * 1987-02-19 1989-06-13 Deere & Company Automatic engine control for an excavator
CN2900632Y (zh) * 2006-03-17 2007-05-16 中南大学 机电一体化挖掘机
CN101413279A (zh) * 2008-11-29 2009-04-22 湖南山河智能机械股份有限公司 机电一体化挖掘装载机及控制方法
CN102947513A (zh) * 2010-06-23 2013-02-27 斗山英维高株式会社 建筑机械的作业轨迹控制装置及其方法
CN102691321A (zh) * 2011-12-08 2012-09-26 上海三一重机有限公司 一种实现铲斗瞬时挖掘转角和挖掘力的优化控制系统及方法
CN104662232A (zh) * 2012-09-25 2015-05-27 沃尔沃建造设备有限公司 用于施工机械的自动整平系统及其控制方法

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
液压挖掘机智能化设计研究;谭琛,宋伟奇;《液压与气动》;20161231;38-43 *

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2020229278A1 (de) * 2019-05-16 2020-11-19 Robert Bosch Gmbh Verfahren zur berechnung eines aushubvolumens

Also Published As

Publication number Publication date
CN106836364A (zh) 2017-06-13

Similar Documents

Publication Publication Date Title
CN106836364B (zh) 智能挖掘机的自动控制系统及最优轨迹规划方法
AU2021203364B2 (en) Excavating earth from a dig site using an excavation vehicle
US8903689B2 (en) Autonomous loading
US11933021B2 (en) Excavating earth from a dig site using an excavation vehicle
US6108949A (en) Method and apparatus for determining an excavation strategy
CN106795705B (zh) 用于控制工作机械的布置
US20080162004A1 (en) Machine control system and method
CN108474196B (zh) 有效载荷监控系统
WO2021086619A1 (en) Systems and methods for autonomous movement of material
CN106460372A (zh) 用于采矿挖掘设备的实际负载重量的方法和系统
WO1999060220A1 (en) Method and apparatus for determining an excavation strategy for a front-end loader
KR20200132217A (ko) 굴삭기의 굴삭 작업 중 버켓 토사량의 측정 방법
CN114722586A (zh) 一种基于堆料面预测模型的智能电铲最优自动挖掘作业方法
EP3896231A1 (en) System and method for automatically performing an earthmoving operation
CN102561445B (zh) 用于判断挖掘机的工作姿态的系统和方法、挖掘机
Yoshida et al. Practical full automation of excavation and loading for hydraulic excavators in indoor environments
US20230243130A1 (en) Excavation plan creation device, working machine, and excavation plan creation method
CN108999228A (zh) 一种双层结构的挖掘机控制系统
JP7201875B2 (ja) 作業機械
CN107326956A (zh) 一种挖泥船的抓斗平挖控制方法及其系统
JP2023168066A (ja) 施工管理システム、施工管理方法、及びプログラム
CN118036330A (zh) 一种基于数字孪生技术的挖掘机管理方法
CN115506431A (zh) 自动铲料系统和自动铲料系统自动铲料控制方法
AU9522798A (en) Method and apparatus for determining an excavation strategy

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