CN109948189A - 一种挖掘机铲斗物料体积与重量测量*** - Google Patents
一种挖掘机铲斗物料体积与重量测量*** Download PDFInfo
- Publication number
- CN109948189A CN109948189A CN201910123799.6A CN201910123799A CN109948189A CN 109948189 A CN109948189 A CN 109948189A CN 201910123799 A CN201910123799 A CN 201910123799A CN 109948189 A CN109948189 A CN 109948189A
- Authority
- CN
- China
- Prior art keywords
- scraper bowl
- point cloud
- volume
- empty
- point
- 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
- 239000000463 material Substances 0.000 title claims abstract description 165
- 238000000034 method Methods 0.000 claims abstract description 45
- 230000004927 fusion Effects 0.000 claims abstract description 13
- 238000005259 measurement Methods 0.000 claims abstract description 12
- 230000011218 segmentation Effects 0.000 claims description 19
- 238000004891 communication Methods 0.000 claims description 16
- 239000011159 matrix material Substances 0.000 claims description 14
- 238000013519 translation Methods 0.000 claims description 10
- 230000009466 transformation Effects 0.000 claims description 9
- 238000009434 installation Methods 0.000 claims description 7
- 238000013459 approach Methods 0.000 claims description 6
- 238000005065 mining Methods 0.000 claims description 4
- 238000013461 design Methods 0.000 claims description 3
- 238000003780 insertion Methods 0.000 claims description 3
- 230000037431 insertion Effects 0.000 claims description 3
- 230000033001 locomotion Effects 0.000 claims description 3
- 238000004220 aggregation Methods 0.000 claims description 2
- 230000002776 aggregation Effects 0.000 claims description 2
- 238000012966 insertion method Methods 0.000 claims 1
- 238000009412 basement excavation Methods 0.000 abstract description 6
- 238000005303 weighing Methods 0.000 abstract description 3
- 238000007781 pre-processing Methods 0.000 abstract description 2
- 238000013480 data collection Methods 0.000 abstract 1
- HUTDUHSNJYTCAR-UHFFFAOYSA-N ancymidol Chemical compound C1=CC(OC)=CC=C1C(O)(C=1C=NC=NC=1)C1CC1 HUTDUHSNJYTCAR-UHFFFAOYSA-N 0.000 description 2
- 238000004364 calculation method Methods 0.000 description 2
- 238000010276 construction Methods 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 238000005516 engineering process Methods 0.000 description 2
- 238000002474 experimental method Methods 0.000 description 2
- 229910052500 inorganic mineral Inorganic materials 0.000 description 2
- 239000011707 mineral Substances 0.000 description 2
- 238000012545 processing Methods 0.000 description 2
- 238000011897 real-time detection Methods 0.000 description 2
- 235000014161 Caesalpinia gilliesii Nutrition 0.000 description 1
- 244000003240 Caesalpinia gilliesii Species 0.000 description 1
- 238000005520 cutting process Methods 0.000 description 1
- 238000013499 data model Methods 0.000 description 1
- 230000007812 deficiency Effects 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000001914 filtration Methods 0.000 description 1
- 230000005484 gravity Effects 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
- 238000007500 overflow downdraw method Methods 0.000 description 1
- 238000012360 testing method Methods 0.000 description 1
Classifications
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02P—CLIMATE CHANGE MITIGATION TECHNOLOGIES IN THE PRODUCTION OR PROCESSING OF GOODS
- Y02P90/00—Enabling technologies with a potential contribution to greenhouse gas [GHG] emissions mitigation
- Y02P90/30—Computing systems specially adapted for manufacturing
Landscapes
- Length Measuring Devices By Optical Means (AREA)
Abstract
本发明涉及一种挖掘机铲斗物料体积与重量测量***,属于液压挖掘机铲斗称重技术领域,包括:激光雷达、计算装置、预处理装置、操纵显示装置。本发明使用一个激光雷达装置在挖掘机作业过程中实现铲斗中物料的动态体积与重量测量;可以对空铲斗进行有效的三维建模,在之后的挖掘作业过程中对装有物料的铲斗进行点云配准融合,解决点云数据采集受到物体遮挡等导致点云采集不完全的局限性,提了高测量精度,降低了测量装置的复杂性。
Description
技术领域
本发明涉及一种基于激光点云的铲斗物料体积与重量测量***,属于液压挖掘机铲斗称重技术领域。
背景技术
挖掘机的应用领域很广泛,它能配合不同的装置进行不一样的工作。在露天采矿工程中,挖掘机可以对矿物的表面进行剥离,完成矿物的挖掘和装卸。尤其在挖掘机配合卡车装载时,如果能知道挖掘物料的重量,就可以防止配合装载运输的卡车超载或欠载,完成精确的装载。这些数据也可以进行施工数据记录,根据施工数据统计分析,合理的分配调度挖掘机,提高生产效率。
专利CN106460372A,用于采矿挖掘设备的实际负责重量的方法和***,基于所扫描的挖掘表面来确定挖掘表面形状,从挖掘设备识别挖掘路径,基于挖掘表面和挖掘路径来实际的计算挖掘的体积,根据密度因数计算重量。专利CN106460372A的缺点:使用多个激光雷达来扫描挖掘设备周围的挖掘表面,将扫描到的多个图像中每一个点进行集合,确定挖掘表面形状,挖掘路径中的物料受挖掘辅助设备的遮挡,需使用编码器等设备记录挖掘路径,需剔除挖掘路径中的点,计算处理复杂。
专利CN103900669B,通过在动臂、斗杆油缸加装压力传感器,在动臂、斗杆、铲斗上加装倾角传感器和陀螺仪,根据凯恩动力学方程实现铲斗物料的动态称重。专利CN103900669B的缺点:该专利的传感器用到了倾角传感器、陀螺仪、压力传感器与数据采集模块相连接,***较为复杂,且动力学模型中铲斗重心不好准确测量,计算的物料重量精度会有影响。
发明内容
本发明针对现有技术的不足,提供一种挖掘机铲斗物料体积与重量测量***,使用一个激光雷达在挖掘机作业的过程中对含有物料的铲斗进行扫描,实现具有以下特点的铲斗物料重量测量:(1)在挖掘机作业过程中即可完成重量测量;(2)可以对空铲斗进行有效的三维点云建模,在之后作业过程中对装有物料的铲斗进行点云融合,解决点云数据采集受到物体遮挡等导致点云采集不完全的局限性;(3)降低重量测量装置的复杂性,提高测量精度。
为了实现上述发明目的,本发明采用以下技术方案:一种挖掘机铲斗物料体积与重量测量***,其特征在于,包括:
激光雷达,用于对装有物料的铲斗进行三维点云动态扫描,并将扫描到的含有地面、动臂、斗杆、铲斗、物料信息的原始三维点云数据通过通讯链路发送给计算装置;
计算装置,用于通过通讯链路接收预处理装置处理得到的空铲斗三维点云数据和空铲斗体积;通过通讯链路接收激光雷达扫描获取的含有装有物料的铲斗的原始三维点云数据;通过一系列算法处理:去噪、聚类、分割、ICP迭代融合获得只含有物料的铲斗的点云数据;计算含有物料的铲斗体积,结合空铲斗体积,计算物料的体积,根据物料的密度计算物料的重量;
预处理装置,用于对空铲斗的三维CAD结构模型进行处理,生成空铲斗三维点云数据,并计算出空铲斗的体积,将生成的空铲斗三维点云数据和计算出来的空铲斗体积通过通讯链路发送给计算装置;
操纵显示装置,用于设定不同物料的密度,并采集、显示计算装置计算的结果给操作者。
所述的预处理装置的工作过程为:
(1)将空铲斗的CAD模型导入Meshlab软件,使用Meshlab软件提供的算法生成空铲斗的三维点云数据;
(2)利用三角剖分方法把点云集分解成三角形组成的几何图形的网络。使用逐点***法在三角网中建立拓扑结构,不断的***新的点来形成新的三角形并更新不同三角形的相邻关系,将空铲斗分割为多个四面体。然后,根据四面体进行空铲斗体积计算;
(3)将预处理得到的结果通过通讯链路发给计算装置。
所述激光雷达在设计安装位置时,结合挖掘机的具体结构尺寸和激光雷达参数,将激光雷达安装挖掘机驾驶室顶部,使得激光雷达的垂直扫描覆盖作业半径区间。
根据挖掘机作业半径和激光雷达的参数来确定有效扫描范围;当挖掘机动臂倾角AS2在A1度到A2度之间,斗杆与动臂之间的角度AS3在A3度到A4度之间,铲斗角度在A5到A6度之间,以上角度范围即是有效采集点云数据的范围。
计算装置中,通过一系列算法处理:去除离群点、超体聚类、CPC约束平面分割、ICP迭代、融合匹配,获得只含有物料的铲斗的点云数据;利用三角剖分法计算有物料的铲斗体积,与空铲斗体积相减,得到物料的体积,根据物料的密度计算物料的重量。
使用空铲斗点云数据确定铲斗的内表面和有效载荷的边界;将含有物料的铲斗点云数据与预处理得到的空铲斗点云数据匹配,使用ICP迭代最近点算法来估计相对于已知空铲斗点云数据的含有物料铲斗的点云的姿态,通过迭代求目标函数的最小值,经过矩阵变换得到位姿的匹配的两个点云集合;两个点云集指的是含有物料的铲斗点云数据与预处理得到的空铲斗点数据。
利用三角剖分法计算有物料的铲斗体积具体为:对有物料的铲斗进行三角剖分成四面体,计算有物料的铲斗体积。
使用激光扫描仪采集数据的过程是动态的,不需要将铲斗固定在特定的位置。
具体地,所述挖掘机铲斗物料体积与重量测量***的工作流程为:
(1)将挖掘机的铲斗CAD模型导入meshlab软件,生成空铲斗的三维点云模型;
(2)利用三角剖分方法得到空铲斗的体积;
(3)通过安装的激光雷达在有效范围内对装有物料的铲斗进行扫描,获得含有地面、动臂、斗杆、铲斗、物料的原始点云数据;
(4)对步骤(3)扫描得到的点云进行滤波,去除离群点;
(5)采用超体聚类和约束平面分割的方法从含有地面、动臂、斗杆、铲斗的点云(即步骤(4)得到的点云)中把含有铲斗的那部分点云分割出来;获得装有物料的铲斗点云;
(6)利用ICP算法评估相对于空铲斗点云模型的铲斗姿态,对空铲斗点云与装有物料的铲斗点云进行匹配融合;
(7)使用三角剖分方法计算融合后的装有物料的铲斗整体的体积;
(8)计算物料体积;
(9)计算物料重量。
更具体地,所述挖掘机铲斗物料体积与重量测量***的工作流程为:
a.将空铲斗的CAD模型导入Meshlab软件,使用软件提供的算法生成空铲斗的三维点;
b.建立空铲斗的三维点云数据模型;
c.利用三角剖分法把点空铲斗点云数据分解成三角形组成的几何图形的网络,使用逐点***法在三角网中建立拓扑结构,不断的***新的点来形成新的三角形并更新不同三角形的相邻关系,将铲斗最终分割为多个四面体,计算四面体的体积,获得空铲斗的体积,根据四面体体积计算空铲斗体积V空;
d.在挖掘机动态作业过程中,通过安装的激光雷达在有效范围内对装有物料的铲斗进行扫描,获得含有地面、动臂、斗杆、铲斗、物料的原始点云数据;
e.对激光雷达扫描得到的点云进行滤波,使用基于输入数据对点到临近点的距离作为判据,如果该点到临近点的平均距离在全局平均距离A7的范围之外,则视为离群点,并从数据集中移除,生成去除离群点后的点云数据;
f.使用超体聚类算法将去除离群点后的点云数据聚类成有地面、动臂、斗杆、铲斗基本特征意义聚集的小块;采用CPC约束平面分割法对小块进行有特征意义的分割,利用不同小块之间的凹凸关系确定分割点,然后根据不同分割点来确定分割的平面;
g.通过分割的平面把含有铲斗的那部分点云分割出来,获得装有物料的铲斗点云数据;
h.使用空铲斗点云数据确定铲斗的内表面和有效载荷的边界,将含有物料的铲斗点云数据与预处理得到的空铲斗点云匹配,由于挖掘过程中的铲斗运动,新获得的含有物料的铲斗点云数据与空铲斗点云模型处于不同的坐标系,会有方向和位置的变化,使用基于最小二乘法的最优匹配ICP迭代最近点算法来估计相对于已知空铲斗点云数据的含有物料铲斗的点云的姿态。通过ICP迭代算法得到符合目标函数要求的平移参数和旋转参数。在匹配的过程中,保证控制点的点对配准融合成功。其经过旋转矩阵R以及平移矩阵t的点云匹配目标函数的公式如下:
其中,两个点云集,分别为空铲斗模型点云中需要匹配的点集X={x1,x2,...,xn}、实时检测到的装有物料的点云中需要匹配的点集Y={y1,y2,...,yn},通过奇异值变换求出旋转矩阵R以及平移矩阵t;经过变换,两个点云集得到位姿的匹配,获得融合后的点云。
i.利用三角剖分方法把融合后含有物料铲斗的点云集分解成三角形组成的几何图形的网络,使用逐点***法在三角网中建立拓扑结构,不断的***新的点来形成新的三角形并更新不同三角形的相邻关系,将含有物料的铲斗分割为多个四面体,然后,根据四面体体积计算出含有物料的铲斗体积V料;
j.用步骤i计算得到的含有物料的铲斗体积减去之前空铲斗的体积得到的是物料的体积;
V目标体积=V料-V空
k.将物料体积与物料的密度相乘,得到物料的重量;
M物料=ρ*V目标体积
循环步骤d-k,即可实现挖掘机作业过程的动态体积和重量测量。
相对于现有技术,本发明的有益效果为:本发明使用一个激光雷达装置在挖掘机作业过程中实现铲斗中物料的动态体积与重量测量;可以对空铲斗进行有效的三维建模,在之后的挖掘作业过程中对装有物料的铲斗进行点云配准融合,解决点云数据采集受到物体遮挡等导致点云采集不完全的局限性,提了高测量精度,降低了测量装置的复杂性。
附图说明
图1为本发明***控制框图;
图2为本发明激光雷达安装示意图;
图3为本发明有效范围内激光雷达扫描采集点云数据的示意图;
图4为本发明体积与重量计算流程图。
具体实施方式
结合图1,为实现上述目的,一种挖掘机铲斗物料体积与重量测量***,至少包括一台多线激光雷达、计算装置、操纵显示装置和预处理装置。
所述多线激光雷达用于对装有物料的铲斗进行三维点云扫描,并将扫描到的含有地面、动臂、斗杆、铲斗等信息的原始三维点云数据通过通讯链路(如Ethernet)发送给计算装置。
所述计算装置用于通过通讯链路(如USB或Ethernet)接收预处理装置处理得到的空铲斗三维点云数据和空铲斗体积;通过通讯链路(如Ethernet)接收多线激光雷达扫描获取的含有装有物料的铲斗的原始三维点云数据;通过一系列算法处理:去噪、聚类、分割、ICP迭代融合获得只含有物料的铲斗的点云数据;计算含有物料的铲斗体积,结合空铲斗体积,计算物料的体积,根据物料的密度计算物料的重量。
所述预处理装置用于对空铲斗的三维CAD结构模型进行处理,生成空铲斗三维点云数据,并计算出空铲斗的体积,将生成的空铲斗三维点云数就和计算出来的空铲斗体积通过通讯链路发送给计算装置。所述通信链路可以是usb can网线的一种或多种,但不限于此,适应车载环境的通信链路均可。
所述操纵显示装置用于设定不同物料的密度,并采集、显示计算装置计算的结果给操作者。
为了获取装有物料的铲斗的点云,需要将激光雷达安装在一个有利的扫描位置。本发明结合挖掘机的结构尺寸和激光雷达参数,将激光雷达安装在挖掘机驾驶室顶前部,使得激光雷达的垂直扫描范围能够覆盖有效的挖掘作业区间,同时使得激光雷达与铲斗同处于回转平台上,减少了因车体回转对扫描点云的影响。
为了获得含有物料的铲斗的有效扫描数据,本发明根据挖掘机作业半径和激光雷达的参数通过实验来确定有效扫描范围;当挖掘机动臂倾角AS2在A1度到A2度之间,斗杆与动臂之间的角度AS3在A3度到A4度之间,铲斗角度在A5到A6度之间时能获得有效的铲斗点云数据(A1…A6根据具体的动臂、斗杆、铲斗尺寸由实验确定)。
为了计算挖掘机铲斗中物料体积与重量,本发明的计算过程如下:
首先,将挖掘机的铲斗CAD模型导入meshlab软件,生成空铲斗的三维点云模型;利用三角剖分方法对空铲斗三维点云模型进行剖分,生成四面体;计算四面体的体积,进而得到空铲斗的体积。
其次,在挖掘机挖掘作业的过程中,使用激光雷达在有效范围内对装有物料的铲斗进行扫描;对扫描得到的点云进行滤波,去除离群点;滤波处理后的点云数据不仅包含铲斗,也包含动臂、斗杆、地面等信息。由此,为获得仅含有铲斗的点云,需要使铲斗的点云与其他挖掘臂、背景等的点云分开,本发明使用超体聚类算法对含有地面、铲斗、动臂等信息的点云进行过分割,将点云分割成具有相邻关系的众多小块;使用CPC算法对超体聚类后的点云小块进行语义分割,由相邻小块之间的中心连线向量与法线向量以及相邻小块是否连通来判断各个小块之间的凹凸关系,通过点云的凹凸信息确定分割的平面,以获得仅含有物料的铲斗点云数据。
最后,因铲斗装有物料时,其铲斗内表面等数据无法扫描到,为确定铲斗有效边界和含有物料的铲斗完整的三维点云数据,使用迭代最近点ICP算法进行三维点云数据匹配,将含有物料的铲斗点云和空铲斗的点云数据进行融合。融合后的点云就是完整的有物料的铲斗信息的点云;同样使用三角剖分方法对融合后的点云进行分割、计算,从而求得含有物料的铲斗体积(包括铲斗体积以及物料的体积)。用有物料的铲斗体积减去空铲斗的体积即得到物料的体积;然后通过不同物料的密度来进一步求出物料重量。
结合图2,本发明结合挖掘机的结构尺寸和激光雷达参数,将激光雷达安装在挖掘机驾驶室顶前部,使得激光雷达的垂直扫描范围能够覆盖有效的挖掘作业区间的同时使得激光雷达与铲斗同处于回转平台上,减少了因车体回转对扫描点云的影响。
结合图3,根据挖掘机作业半径和激光雷达的参数来确定有效扫描范围;当挖掘机动臂倾角AS2在A1度到A2度之间,斗杆与动臂之间的角度AS3在A3度到A4度之间,铲斗角度在A5到A6度之间,(A1…A6根据具体的动臂、斗杆、铲斗尺寸由实验确定)此范围即是有效采集点云数据的范围。在一个实施例中,以激光雷达扫描到挖斗内物料为有效范围,动臂倾角AS2在30°~60°,斗杆与动臂之间的角度AS3在45°~90°,铲斗角度AS4在90°~180°之间时,是有效的点云数据扫描范围。
同时从图3也可以看出,即使在有效的扫描范围内,激光雷达扫描到的点云数据也信息复杂含有地面、动臂、斗杆、铲斗的点云信息。
结合图4,本发明体积与重量计算分为两大部分,其中第1到3步为预处理部分,针对不同的铲斗只需要处理一次;第4到10步为计算物料体积和重量部分,可在挖掘作业过程中循环动态测量;整个流程详述如下:
(1)首先将指定的挖掘机空铲斗CAD模型导入Meshlab软件,使用软件提供的算法将CAD模型生成空铲斗的三维点云数据;
(2)利用三角剖分法把空铲斗点云分解成三角形组成的几何图形的网络,使用逐点***算法在三角网中建立拓扑结构,将铲斗最终分割为多个四面体。我们在每四个点形成的四面体上求取体积从而获得整个铲斗的体积,不同四面体之间可能有共享的点和共享的面,但没有重叠的区域(指能用于计算体积的区域),从而使得整个铲斗的体积计算准确。根据四面体体积公式计算空铲斗体积V空;
(3)在挖掘机动态作业过程中,通过安装的激光雷达在有效范围内对装有物料的铲斗进行扫描,获得含有地面、动臂、斗杆、铲斗、物料等多个目标的原始点云数据。
(4)对扫描得到的原始点云数据进行滤波处理,对扫描得到的点云进行滤波,在每一个点的邻域内求与该点的平均距离,邻域内的每一个的平均距离构成一个样本,根据样本的数据可以求得均值以及方差。其中如果某一个点的平均距离在均值之外,则认为是离群点并从数据集中移除,最终生成去除离群点后的点云数据。
(5)使用超体聚类算法将除去离群点后的点云数据聚类成多个小块,对点云数据进行超体分割之后,采用拓展凸型准测以及完善准则算法来计算不同小块之间的凹凸关系。获得凹凸关系之后,CPC约束平面分割法对每一个点云赋予权重,凹块赋值为1,其他为0。垂直于凹边表面的点具有更高的权重,最后通过随机样本一致性算法(RanSaC)进行平面切割。
(6)通过分割平面可以把铲斗的那部分点云从整个点云数据中分割出来,获得装有物料的铲斗点云数据。
(7)使用空铲斗点云数据确定铲斗的内表面和有效载荷的边界,将含有物料的铲斗点云数据与预处理得到的空铲斗点云匹配,由于挖掘过程中的铲斗运动,新获得的含有物料的铲斗点云数据与空铲斗点云模型处于不同的坐标系,会有方向和位置的变化,使用基于最小二乘法的最优匹配ICP迭代最近点算法来估计相对于已知空铲斗点云数据的含有物料铲斗的点云的姿态。通过ICP迭代算法得到符合目标函数要求的平移参数和旋转参数。在匹配的过程中,保证控制点的点对配准融合成功。其经过旋转矩阵R以及平移矩阵t的点云匹配目标函数的公式如下:
其中,两个点云集,分别为空铲斗模型点云中需要匹配的点集X={x1,x2,...,xn}、实时检测到的装有物料的点云中需要匹配的点集Y={y1,y2,...,yn},通过奇异值变换求出旋转矩阵R以及平移矩阵t;经过变换,两个点云集得到位姿的匹配,获得融合后的点云。
(8)对(7)获得融合后的铲斗点云求其体积,求解方法同步骤(2),根据四面体体积计算出含有物料的铲斗体积V料;
(9)计算得到的含有物料的铲斗体积与之前空铲斗的体积相减得到的是物料的体积;
V目标体积=V料-V空
(10)将物料体积与物料的密度相乘,得到物料的重量;
M物料=ρ*V目标体积
循环步骤3-10,即可实现挖掘机作业过程的动态体积和重量测量。
本发明使用一个激光雷达的装置在挖掘机作业的过程中实现动态的物料重量计算;可以对空铲斗进行有效的三维建模,在之后作业中对装有物料的铲斗进行点云配准融合,解决点云数据采集受到物体遮挡等不完全的局限性;降低重量计算的装置复杂性,提高测量精度。
缩略语和关键术语定义
铲斗物料---挖掘机使用其铲斗挖掘待挖掘物料后,装载在铲斗中的物料。
点云---在逆向工程中通过测量仪器得到的产品外观表面的点的数据集合。
三角剖分法---把曲面剖开成曲边三角形,且任何两个这样的曲边三角形,要么不相交,要么恰好相交于一条公共边。
离群点---是一个数据对象,它显著不同于其他数据对象,在特征空间中,离群点对象与其最近邻之间的邻近性显著偏离数据集中的其他对象与它们自己的最近邻之间的邻近性。
超体聚类---对点云实施过分割,将场景点云化成很多小块,并研究每个小块之间的关系。本质上这种方法是对局部的一种总结,纹理,材质,颜色类似的部分会被自动的分割成一块,超体聚类有利于后续识别工作。
CPC约束平面分割---是利用不同小块之间的凹凸关系确定分割点,然后根据不同分割点来确定分割的平面,此方法能够将物体分成有意义的块。
ICP算法---基于最小二乘法的最优配准融合方法,该算法重复进行选择对应关系点对,计算最优刚体变换,直到满足正确配准融合的收敛精度要求。
配准融合---把不同的坐标系中测得到的点云数据进行坐标系的变换,以得到整体的数据模型。
需要说明的是,以上所述仅为本发明的实施例,并非因此限制本发明的专利范围,凡是利用本发明说明书内容所做的等效结构或等效流程变换,或直接或间接运用在其他相关技术领域,均同理包括在本发明的专利保护范围内。
Claims (10)
1.一种挖掘机铲斗物料体积与重量测量***,其特征在于,包括:
激光雷达,用于对装有物料的铲斗进行三维点云动态扫描,并将扫描到的含有地面、动臂、斗杆、铲斗、物料信息的原始三维点云数据通过通讯链路发送给计算装置;
计算装置,用于通过通讯链路接收预处理装置处理得到的空铲斗三维点云数据和空铲斗体积;通过通讯链路接收激光雷达扫描获取的含有装有物料的铲斗的原始三维点云数据;通过一系列算法处理:去噪、聚类、分割、ICP迭代融合获得只含有物料的铲斗的点云数据;计算含有物料的铲斗体积,结合空铲斗体积,计算物料的体积,根据物料的密度计算物料的重量;
预处理装置,用于对空铲斗的三维CAD结构模型进行处理,生成空铲斗三维点云数据,并计算出空铲斗的体积,将生成的空铲斗三维点云数据和计算出来的空铲斗体积通过通讯链路发送给计算装置;
操纵显示装置,用于设定不同物料的密度,并采集、显示计算装置计算的结果给操作者。
2.根据权利要求1所述的一种挖掘机铲斗物料体积与重量测量***,其特征在于,所述的预处理装置的工作过程为:
(1)将空铲斗的CAD模型导入Meshlab软件,使用Meshlab软件提供的算法生成空铲斗的三维点云数据;
(2)利用三角剖分方法把点云集分解成三角形组成的几何图形的网络。使用逐点***法在三角网中建立拓扑结构,不断的***新的点来形成新的三角形并更新不同三角形的相邻关系,将空铲斗分割为多个四面体。然后,根据四面体进行空铲斗体积计算;
(3)将预处理得到的结果通过通讯链路发给计算装置。
3.根据权利要求1所述的一种挖掘机铲斗物料体积与重量测量***,其特征在于,结合挖掘机的具体结构尺寸和激光雷达参数,将激光雷达安装挖掘机驾驶室顶部,使得激光雷达的垂直扫描覆盖作业半径区间。
4.根据权利要求1所述的一种挖掘机铲斗物料体积与重量测量***,其特征在于,根据挖掘机作业半径和激光雷达的参数来确定有效扫描范围;当挖掘机动臂倾角AS2在A1度到A2度之间,斗杆与动臂之间的角度AS3在A3度到A4度之间,铲斗角度在A5到A6度之间,以上角度范围即是有效采集点云数据的范围。
5.根据权利要求1所述的一种挖掘机铲斗物料体积与重量测量***,其特征在于,计算装置中,通过一系列算法处理:去除离群点、超体聚类、CPC约束平面分割、ICP迭代、融合匹配,获得含有物料的铲斗的点云数据;利用三角剖分法计算有物料的铲斗体积,与空铲斗体积相减得到物料的体积,根据物料的密度计算物料的重量。
6.根据权利要求5所述的一种挖掘机铲斗物料体积与重量测量***,其特征在于,计算装置中,使用空铲斗点云数据确定铲斗的内表面和有效载荷的边界;将含有物料的铲斗点云数据与预处理得到的空铲斗点云数据匹配,使用ICP迭代最近点算法来估计相对于已知空铲斗点云数据的含有物料铲斗的点云的姿态,通过迭代求目标函数的最小值,经过矩阵变换,得到位姿的匹配的两个点云集对齐;两个点云集指的是含有物料的铲斗点云数据与预处理得到的空铲斗点数据。
7.根据权利要求5所述的一种挖掘机铲斗物料体积与重量测量***,其特征在于,利用三角剖分法计算有物料的铲斗体积具体为:对有物料的铲斗进行三角剖分成四面体,计算有物料的铲斗体积。
8.根据权利要求5所述的一种挖掘机铲斗物料体积与重量测量***,其特征在于,使用激光扫描仪采集数据的过程是动态的,无需将铲斗固定在特定的位置。
9.根据权利要求1所述的一种挖掘机铲斗物料体积与重量测量***,其特征在于,所述挖掘机铲斗物料体积与重量测量***的工作流程为:
(1)将挖掘机的铲斗CAD模型导入meshlab软件,生成空铲斗的三维点云模型;
(2)利用三角剖分方法得到空铲斗的体积;
(3)通过安装的激光雷达在有效范围内对装有物料的铲斗进行扫描,获得含有地面、动臂、斗杆、铲斗、物料的原始点云数据;
(4)对步骤(3)扫描得到的点云进行滤波,去除离群点;
(5)采用超体聚类和约束平面分割的方法从含有地面、动臂、斗杆、铲斗的点云中把含有铲斗的那部分点云分割出来;获得装有物料的铲斗点云;
(6)利用ICP算法评估相对于空铲斗点云模型的铲斗姿态,对空铲斗点云与装有物料的铲斗点云进行匹配融合;
(7)使用三角剖分方法计算融合后的装有物料的铲斗整体的体积;
(8)计算物料体积;
(9)计算物料重量。
10.根据权利要求1所述的一种挖掘机铲斗物料体积与重量测量***,其特征在于,所述挖掘机铲斗物料体积与重量测量***的工作流程为:
a.将空铲斗的CAD模型导入Meshlab软件,使用软件提供的算法生成空铲斗的三维点云数据;
b.利用三角剖分法把点空铲斗点云数据分解成三角形组成的几何图形的网络,使用逐点***法在三角网中建立拓扑结构,不断的***新的点来形成新的三角形并更新不同三角形的相邻关系,将铲斗最终分割为多个四面体,计算四面体的体积,获得空铲斗的体积,根据四面体体积计算空铲斗体积V空;
c.在挖掘机动态作业过程中,通过安装的激光雷达在有效范围内对装有物料的铲斗进行扫描,获得含有地面、动臂、斗杆、铲斗、物料的原始点云数据;
d.对激光雷达扫描得到的点云进行滤波,使用基于输入数据对点到临近点的距离作为判据,如果该点到临近点的平均距离在全局平均距离范围之外,则视为离群点并从数据集中移除,生成去除离群点后的点云数据;
e.使用超体聚类算法将去除离群点后的点云数据聚类成有地面、动臂、斗杆、铲斗基本特征意义聚集的小块;采用CPC约束平面分割法利用不同小块之间的凹凸关系确定分割点,然后根据不同分割点来确定分割的平面;
f.通过分割的平面把含有铲斗的那部分点云分割出来,获得装有物料的铲斗点云数据;
g.使用空铲斗点云数据确定铲斗的内表面和有效载荷的边界,将含有物料的铲斗点云数据与预处理得到的空铲斗点云匹配,由于挖掘过程中的铲斗运动,新获得的含有物料的铲斗点云数据与空铲斗点云模型处于不同的坐标系,会有方向和位置的变化,使用基于最小二乘法的最优匹配ICP迭代最近点算法来估计相对于已知空铲斗点云数据的含有物料铲斗的点云的姿态;通过ICP迭代算法得到符合目标函数要求的平移参数和旋转参数;在匹配的过程中,保证控制点的点对配准融合成功;其经过旋转矩阵R以及平移矩阵t的点云匹配目标函数的公式如下:
其中,两个点云集,分别为空铲斗模型点云中需要匹配的点集X={x1,x2,...,xn}、实时检测到的装有物料的点云中需要匹配的点集Y={y1,y2,...,yn},通过奇异值变换求出旋转矩阵R以及平移矩阵t;经过变换,两个点云集得到位姿的匹配,获得融合后的点云;
i.利用三角剖分方法把融合后含有物料铲斗的点云集分解成三角形组成的几何图形的网络,使用逐点***法在三角网中建立拓扑结构,不断的***新的点来形成新的三角形并更新不同三角形的相邻关系,将含有物料的铲斗分割为多个四面体,然后,根据四面体体积计算出含有物料的铲斗体积V料;
j.用步骤i计算得到的含有物料的铲斗体积减去之前空铲斗的体积得到的是物料的体积;
V目标体积=V料-V空
k.将物料体积与物料的密度相乘,得到物料的重量;
M物料=ρ*V目标体积
循环步骤d-k,即可实现挖掘机作业过程的动态体积和重量测量。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910123799.6A CN109948189B (zh) | 2019-02-19 | 2019-02-19 | 一种挖掘机铲斗物料体积与重量测量*** |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910123799.6A CN109948189B (zh) | 2019-02-19 | 2019-02-19 | 一种挖掘机铲斗物料体积与重量测量*** |
Publications (2)
Publication Number | Publication Date |
---|---|
CN109948189A true CN109948189A (zh) | 2019-06-28 |
CN109948189B CN109948189B (zh) | 2023-05-05 |
Family
ID=67008030
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910123799.6A Active CN109948189B (zh) | 2019-02-19 | 2019-02-19 | 一种挖掘机铲斗物料体积与重量测量*** |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN109948189B (zh) |
Cited By (16)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110595356A (zh) * | 2019-09-10 | 2019-12-20 | 湖南海森格诺信息技术有限公司 | 人工储物环境中固体体积的测量方法 |
CN110807810A (zh) * | 2019-10-30 | 2020-02-18 | 武汉理工大学 | 基于三维点云的拆卸产品结构机器人视觉识别方法 |
CN110887440A (zh) * | 2019-12-03 | 2020-03-17 | 西安科技大学 | 基于结构光的挖掘机挖斗土方体积实时测量方法及测量装置 |
CN111062254A (zh) * | 2019-11-18 | 2020-04-24 | 厦门大学 | 一种装载机铲斗内物料堆积密度评估方法和装置 |
CN111368664A (zh) * | 2020-02-25 | 2020-07-03 | 吉林大学 | 基于机器视觉和铲斗位置信息融合的装载机满斗率识别方法 |
CN111553604A (zh) * | 2020-05-06 | 2020-08-18 | 三一重机有限公司 | 铲斗适配检测方法、装置、检测设备及可读存储介质 |
CN112257624A (zh) * | 2020-10-28 | 2021-01-22 | 山东金软科技股份有限公司 | 一种基于边缘计算实现的矿井运输电机车自动计量*** |
WO2021102967A1 (zh) * | 2019-11-29 | 2021-06-03 | 深圳市大疆创新科技有限公司 | 点云密度的量化方法、装置和存储介质 |
CN113160143A (zh) * | 2021-03-23 | 2021-07-23 | 中南大学 | 物料搅拌槽内物料液面高度测量方法及*** |
CN113281777A (zh) * | 2021-04-07 | 2021-08-20 | 深圳市异方科技有限公司 | 一种货物体积动态测量方法及其测量装置 |
CN114445469A (zh) * | 2022-02-15 | 2022-05-06 | 北京壬工智能科技有限公司 | 无人机自主调度的物料堆垛盘点装置、***及其方法 |
CN114543666A (zh) * | 2022-01-20 | 2022-05-27 | 大连理工大学 | 一种基于矿场环境感知的堆料面预测方法 |
CN114761642A (zh) * | 2019-11-26 | 2022-07-15 | 神钢建机株式会社 | 测量装置以及工程机械 |
CN116068572A (zh) * | 2022-12-09 | 2023-05-05 | 中建材凯盛机器人(上海)有限公司 | 基于激光雷达实现车体轮廓检测处理的***、方法、装置、处理器及其计算机可读存储介质 |
CN116750436A (zh) * | 2023-08-15 | 2023-09-15 | 四川蜀道建筑科技有限公司 | 一种高度可自动调节的送料皮带机 |
CN117331093A (zh) * | 2023-11-30 | 2024-01-02 | 江苏智能无人装备产业创新中心有限公司 | 一种基于铲斗位置剔除的无人驾驶装载机障碍物感知方法 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106017320A (zh) * | 2016-05-30 | 2016-10-12 | 燕山大学 | 一种基于图像处理的散杂货堆体积测量方法及实现所述方法的*** |
CN106932784A (zh) * | 2017-04-20 | 2017-07-07 | 河北科技大学 | 基于二维激光雷达的车斗形容器三维扫描***测量方法 |
CN108549337A (zh) * | 2018-04-02 | 2018-09-18 | 泰富智能科技有限公司 | 一种取料的调度方法 |
-
2019
- 2019-02-19 CN CN201910123799.6A patent/CN109948189B/zh active Active
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106017320A (zh) * | 2016-05-30 | 2016-10-12 | 燕山大学 | 一种基于图像处理的散杂货堆体积测量方法及实现所述方法的*** |
CN106932784A (zh) * | 2017-04-20 | 2017-07-07 | 河北科技大学 | 基于二维激光雷达的车斗形容器三维扫描***测量方法 |
CN108549337A (zh) * | 2018-04-02 | 2018-09-18 | 泰富智能科技有限公司 | 一种取料的调度方法 |
Cited By (25)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110595356A (zh) * | 2019-09-10 | 2019-12-20 | 湖南海森格诺信息技术有限公司 | 人工储物环境中固体体积的测量方法 |
CN110807810A (zh) * | 2019-10-30 | 2020-02-18 | 武汉理工大学 | 基于三维点云的拆卸产品结构机器人视觉识别方法 |
CN111062254A (zh) * | 2019-11-18 | 2020-04-24 | 厦门大学 | 一种装载机铲斗内物料堆积密度评估方法和装置 |
CN111062254B (zh) * | 2019-11-18 | 2022-05-10 | 厦门大学 | 一种装载机铲斗内物料堆积密度评估方法和装置 |
CN114761642B (zh) * | 2019-11-26 | 2023-05-09 | 神钢建机株式会社 | 测量装置以及工程机械 |
CN114761642A (zh) * | 2019-11-26 | 2022-07-15 | 神钢建机株式会社 | 测量装置以及工程机械 |
WO2021102967A1 (zh) * | 2019-11-29 | 2021-06-03 | 深圳市大疆创新科技有限公司 | 点云密度的量化方法、装置和存储介质 |
CN110887440A (zh) * | 2019-12-03 | 2020-03-17 | 西安科技大学 | 基于结构光的挖掘机挖斗土方体积实时测量方法及测量装置 |
CN110887440B (zh) * | 2019-12-03 | 2021-05-04 | 西安科技大学 | 基于结构光的挖掘机挖斗土方体积实时测量方法及测量装置 |
CN111368664B (zh) * | 2020-02-25 | 2022-06-14 | 吉林大学 | 基于机器视觉和铲斗位置信息融合的装载机满斗率识别方法 |
CN111368664A (zh) * | 2020-02-25 | 2020-07-03 | 吉林大学 | 基于机器视觉和铲斗位置信息融合的装载机满斗率识别方法 |
CN111553604A (zh) * | 2020-05-06 | 2020-08-18 | 三一重机有限公司 | 铲斗适配检测方法、装置、检测设备及可读存储介质 |
CN111553604B (zh) * | 2020-05-06 | 2023-12-08 | 三一重机有限公司 | 铲斗适配检测方法、装置、检测设备及可读存储介质 |
CN112257624A (zh) * | 2020-10-28 | 2021-01-22 | 山东金软科技股份有限公司 | 一种基于边缘计算实现的矿井运输电机车自动计量*** |
CN112257624B (zh) * | 2020-10-28 | 2023-05-23 | 山东金软科技股份有限公司 | 一种基于边缘计算实现的矿井运输电机车自动计量*** |
CN113160143B (zh) * | 2021-03-23 | 2022-05-24 | 中南大学 | 物料搅拌槽内物料液面高度测量方法及*** |
CN113160143A (zh) * | 2021-03-23 | 2021-07-23 | 中南大学 | 物料搅拌槽内物料液面高度测量方法及*** |
CN113281777A (zh) * | 2021-04-07 | 2021-08-20 | 深圳市异方科技有限公司 | 一种货物体积动态测量方法及其测量装置 |
CN114543666A (zh) * | 2022-01-20 | 2022-05-27 | 大连理工大学 | 一种基于矿场环境感知的堆料面预测方法 |
CN114543666B (zh) * | 2022-01-20 | 2022-11-29 | 大连理工大学 | 一种基于矿场环境感知的堆料面预测方法 |
CN114445469A (zh) * | 2022-02-15 | 2022-05-06 | 北京壬工智能科技有限公司 | 无人机自主调度的物料堆垛盘点装置、***及其方法 |
CN116068572A (zh) * | 2022-12-09 | 2023-05-05 | 中建材凯盛机器人(上海)有限公司 | 基于激光雷达实现车体轮廓检测处理的***、方法、装置、处理器及其计算机可读存储介质 |
CN116750436A (zh) * | 2023-08-15 | 2023-09-15 | 四川蜀道建筑科技有限公司 | 一种高度可自动调节的送料皮带机 |
CN117331093A (zh) * | 2023-11-30 | 2024-01-02 | 江苏智能无人装备产业创新中心有限公司 | 一种基于铲斗位置剔除的无人驾驶装载机障碍物感知方法 |
CN117331093B (zh) * | 2023-11-30 | 2024-01-26 | 江苏智能无人装备产业创新中心有限公司 | 一种基于铲斗位置剔除的无人驾驶装载机障碍物感知方法 |
Also Published As
Publication number | Publication date |
---|---|
CN109948189B (zh) | 2023-05-05 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109948189A (zh) | 一种挖掘机铲斗物料体积与重量测量*** | |
AU2010265789B2 (en) | Autonomous loading | |
US11417008B2 (en) | Estimating a volume of contents in a container of a work vehicle | |
CN110805093B (zh) | 利用视觉传感器进行反馈回路控制的容器角度感测 | |
JP7365122B2 (ja) | 画像処理システムおよび画像処理方法 | |
CA3107035C (en) | Excavating earth from a dig site using an excavation vehicle | |
EP2758605B1 (en) | Method for selecting an attack pose for a working machine having a bucket | |
KR101151375B1 (ko) | 대단면 기초 지질조사방법 | |
KR102104304B1 (ko) | 굴삭기 전용 3d 스캐너를 이용한 토공 지형정보 실시간 모델링 시스템 및 방법 | |
CN109902857A (zh) | 一种运输车辆装载点自动规划方法及*** | |
Bewley et al. | Real-time volume estimation of a dragline payload | |
Guevara et al. | Point cloud-based estimation of effective payload volume for earthmoving loaders | |
CN112161622A (zh) | 一种机器人足迹规划方法、装置、可读存储介质及机器人 | |
CN115690354A (zh) | 一种基于三维实景数值分析的浅埋隧道施工动态控制方法 | |
CN111445569B (zh) | 一种沉积地质演化动态模拟方法 | |
Błaszczak-Bąk et al. | Optimization of point clouds for 3D bas-relief modeling | |
CN117313343A (zh) | 一种基于三维激光扫描仪***区域数字化模型获取方法 | |
Bleier et al. | Signed distance function based surface reconstruction of a submerged inland mine using continuous-time slam | |
CN113686600B (zh) | 一种旋耕机、开沟机性能鉴定装置 | |
Borthwick | Mining haul truck pose estimation and load profiling using stereo vision | |
Savu et al. | 3d modelling using laser scanning technique | |
CN115795580B (zh) | 基于云计算的智能开挖施工管理*** | |
KR101988352B1 (ko) | 블록 지반 모델링과 3차원 위치정보를 이용한 토공량 산정 시스템 | |
Chae et al. | 3D work environment modeling for the intelligent excavation system (IES) | |
CN118015209A (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 |