CN113706702A - 矿区三维地图构建系统和方法 - Google Patents
矿区三维地图构建系统和方法 Download PDFInfo
- Publication number
- CN113706702A CN113706702A CN202110920940.2A CN202110920940A CN113706702A CN 113706702 A CN113706702 A CN 113706702A CN 202110920940 A CN202110920940 A CN 202110920940A CN 113706702 A CN113706702 A CN 113706702A
- Authority
- CN
- China
- Prior art keywords
- point cloud
- local
- dimensional
- dimensional point
- cloud picture
- 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.)
- Pending
Links
- 238000005065 mining Methods 0.000 title claims abstract description 57
- 238000010276 construction Methods 0.000 title claims abstract description 27
- 238000000034 method Methods 0.000 title claims description 24
- 238000005259 measurement Methods 0.000 claims description 53
- 239000011159 matrix material Substances 0.000 claims description 38
- 238000009616 inductively coupled plasma Methods 0.000 claims description 23
- 238000006243 chemical reaction Methods 0.000 claims description 18
- 238000012545 processing Methods 0.000 claims description 10
- 238000013519 translation Methods 0.000 claims description 6
- 238000012804 iterative process Methods 0.000 claims description 5
- 238000013507 mapping Methods 0.000 claims 2
- 239000000428 dust Substances 0.000 abstract description 9
- 230000008859 change Effects 0.000 abstract description 4
- 230000004927 fusion Effects 0.000 description 12
- 230000008569 process Effects 0.000 description 7
- 238000004891 communication Methods 0.000 description 4
- 230000000295 complement effect Effects 0.000 description 4
- 238000010586 diagram Methods 0.000 description 3
- 230000000694 effects Effects 0.000 description 3
- 239000000463 material Substances 0.000 description 3
- 239000011435 rock Substances 0.000 description 3
- 238000001514 detection method Methods 0.000 description 2
- 238000005516 engineering process Methods 0.000 description 2
- 238000001914 filtration Methods 0.000 description 2
- 230000001788 irregular Effects 0.000 description 2
- 238000005457 optimization Methods 0.000 description 2
- 230000008447 perception Effects 0.000 description 2
- 230000002093 peripheral effect Effects 0.000 description 2
- 230000036544 posture Effects 0.000 description 2
- 230000009467 reduction Effects 0.000 description 2
- 238000009412 basement excavation Methods 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 230000006870 function Effects 0.000 description 1
- 230000036541 health Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06T—IMAGE DATA PROCESSING OR GENERATION, IN GENERAL
- G06T17/00—Three dimensional [3D] modelling, e.g. data description of 3D objects
- G06T17/05—Geographic models
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06T—IMAGE DATA PROCESSING OR GENERATION, IN GENERAL
- G06T17/00—Three dimensional [3D] modelling, e.g. data description of 3D objects
- G06T17/20—Finite element generation, e.g. wire-frame surface description, tesselation
Landscapes
- Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- Geometry (AREA)
- Software Systems (AREA)
- Computer Graphics (AREA)
- General Physics & Mathematics (AREA)
- Theoretical Computer Science (AREA)
- Remote Sensing (AREA)
- Navigation (AREA)
Abstract
本发明提供了一种矿区三维地图构建系统和方法,通过无人机方便快捷地得到矿区全局的三维点云图为底图,然后与路侧感知端及矿车实时获取的局部三维点云图进行融合得到全局三维点云图,与现有技术中仅靠车辆本身携带的设备进行扫描来构建三维地图的方式相比,三维地图构建更容易,构建速度更快,能够根据矿区地形变化情况更及时地更新三维地图;而且与现有技术中仅靠车辆本身携带的设备进行扫描来构建三维地图的方式相比,能够在扬尘环境中构建出更大范围的三维地图。
Description
技术领域
本发明涉及自动驾驶技术领域,尤其涉及一种矿区三维地图构建系统和方法。
背景技术
自动驾驶技术不仅能避免或减少对驾驶人员健康、安全的危害或威胁,而且将大幅提升效率、降低成本,更加经济、节能和环保,因此在露天矿场中具有较好的应用前景,可在矿车上应用以实现物料的无人化运输。要实现矿车的自动驾驶,需要先构建矿场的三维高精度地图,以用于进行路径规划;现有的三维高精度地图的构建方法一般是针对城市道路而开发的,仅靠车辆本身携带的设备进行扫描来构建三维地图,而矿区与城市环境相比,具有扬尘密度大、随着采掘进度不同地形环境变化较快、道路上经常出现洒落物和坡道落石等特点,从而导致以下问题:
1.由于地形环境变化较快需要经常重新构建三维地图,对于传统的三维地图构建方法,耗时耗力,降低矿区的作业效率;
2.由于扬尘密度大,传感器的有效距离大大缩小,而传统方法中仅依靠车上的传感器进行点云数据采集,难以构建矿区全貌的三维地图;
3.由于道路上经常出现洒落物和坡道落石会对道路造成损害,仅依靠车上的传感器进行点云数据采集,难以掌握道路实时情况。
发明内容
鉴于上述现有技术的不足之处,本申请实施例的目的在于提供一种矿区三维地图构建系统和方法,旨在解决矿区环境下三维地图构建困难、繁琐和更新不及时的问题。
第一方面,本申请实施例提供一种矿区三维地图构建系统,包括无人机、矿车和多个路侧感知端,所述无人机、矿车和路侧感知端均包括激光雷达、差分GNSS导航设备、IMU惯性测量单元;
所述无人机用于通过对应的激光雷达、差分GNSS导航设备、IMU惯性测量单元获取矿区全局的三维点云图作为底图,并发送至所述矿车;
所述路侧感知端设置在矿区道路的路侧,并用于通过对应的激光雷达、差分GNSS导航设备、IMU惯性测量单元获取路侧感知端所在区域的第一局部三维点云图,并发送至所述矿车;
所述矿车用于通过对应的激光雷达、差分GNSS导航设备、IMU惯性测量单元获取矿车所在区域的第二局部三维点云图,把所述第一局部三维点云图和所述第二局部三维点云图进行融合,得到初步融合的局部三维点云图,然后把所述初步融合的局部三维点云图与所述底图进行融合得到融合的全局三维点云图。
本申请实施例的矿区三维地图构建系统,当矿区地形改变时,可通过无人机方便快捷地得到矿区全局的三维点云图为底图,然后与路侧感知端及矿车实时获取的局部三维点云图进行融合得到全局三维点云图,与现有技术中仅靠车辆本身携带的设备进行扫描来构建三维地图的方式相比,三维地图构建更容易,构建速度更快,能够根据矿区地形变化情况更及时地更新三维地图;而且与现有技术中仅靠车辆本身携带的设备进行扫描来构建三维地图的方式相比,能够在扬尘环境中构建出更大范围的三维地图。
优选地,所述无人机、矿车和路侧感知端在通过对应的激光雷达、差分GNSS导航设备、IMU惯性测量单元获取对应的三维点云图的时候:
用激光雷达获取扫描点在激光雷达坐标系中的坐标;
根据以下公式计算所述扫描点在地心直角坐标系中的坐标:
其中,为扫描点在地心直角坐标系中的坐标,为对应的IMU惯性测量单元中心在地心直角坐标系中的坐标,为对应的IMU惯性测量单元坐标系至地心直角坐标系的旋转矩阵,为所述激光雷达的激光雷达坐标系中心到所述IMU惯性测量单元中心的偏置在所述IMU惯性测量单元坐标系中的分量,为所述激光雷达坐标系到所述IMU惯性测量单元坐标系的旋转矩阵,为所述扫描点在所述激光雷达坐标系中的坐标。
优选地,所述矿车在把所述第一局部三维点云图和所述第二局部三维点云图进行融合的时候:
基于各点在地心直角坐标系中的坐标,对所述第一局部三维点云图和所述第二局部三维点云图进行拼接。
优选地,所述矿车在把所述初步融合的局部三维点云图与所述底图进行融合得到融合的全局三维点云图的时候:
采用基于ICP算法的点云匹配方式对所述初步融合的局部三维点云图与所述底图进行点云拼接。
优选地,所述矿车在采用基于ICP算法的点云匹配方式对所述初步融合的局部三维点云图与所述底图进行点云拼接的时候,执行以下步骤:
根据以下公式计算总旋转矩阵、旋转向量和第n次迭代处理的旋转后的第一同名特征点集:
C3.根据以下公式对所述初步融合的局部三维点云图的各点进行转换处理,并用转换处理后的初步融合的局部三维点云图与所述底图进行拼接:
优选地,步骤C1包括:
第二方面,本申请实施例提供一种矿区三维地图构建方法,包括步骤:
A1.获取由无人机通过设置在所述无人机上的激光雷达、差分GNSS导航设备、IMU惯性测量单元获得的矿区全局的三维点云图作为底图;
A2.获取由路侧感知端通过设置在所述路侧感知端上的激光雷达、差分GNSS导航设备、IMU惯性测量单元获得的路侧感知端所在区域的第一局部三维点云图;所述路侧感知端设置在矿区道路的路侧;
A3.获取由矿车通过设置在所述矿车上的激光雷达、差分GNSS导航设备、IMU惯性测量单元获得的矿车所在区域的第二局部三维点云图;
A4.把所述第一局部三维点云图和所述第二局部三维点云图进行融合,得到初步融合的局部三维点云图;
A5.把所述初步融合的局部三维点云图与所述底图进行融合得到融合的全局三维点云图。
优选地,步骤A4包括:
基于各点在地心直角坐标系中的坐标,对所述第一局部三维点云图和所述第二局部三维点云图进行拼接。
优选地,步骤A5包括:
采用基于ICP算法的点云匹配方式对所述初步融合的局部三维点云图与所述底图进行点云拼接。
优选地,所述采用基于ICP算法的点云匹配方式对所述初步融合的局部三维点云图与所述底图进行点云拼接的步骤包括:
根据以下公式计算总旋转矩阵、旋转向量和第n次迭代处理的旋转后的第一同名特征点集:
C3.根据以下公式对所述初步融合的局部三维点云图的各点进行转换处理,并用转换处理后的初步融合的局部三维点云图与所述底图进行拼接:
有益效果:
本申请实施例提供的矿区三维地图构建系统和方法,当矿区地形改变时,可通过无人机方便快捷地得到矿区全局的三维点云图为底图,然后与路侧感知端及矿车实时获取的局部三维点云图进行融合得到全局三维点云图,与现有技术中仅靠车辆本身携带的设备进行扫描来构建三维地图的方式相比,三维地图构建更容易,构建速度更快,能够根据矿区地形变化情况更及时地更新三维地图;而且与现有技术中仅靠车辆本身携带的设备进行扫描来构建三维地图的方式相比,能够在扬尘环境中构建出更大范围的三维地图。
附图说明
图1为本申请实施例提供的矿区三维地图构建系统的结构示意图。
图2为本申请实施例提供的矿区三维地图构建系统方法的流程图。
图3为激光扫描定位原理图。
图4为基于ICP算法的点云匹配方式进行点云拼接的效果图。
图5为用于进行点云拼接的第一个点云图。
图6为用于进行点云拼接的第二个点云图。
具体实施方式
下面详细描述本发明的实施方式,所述实施方式的示例在附图中示出,其中自始至终相同或类似的标号表示相同或类似的元件或具有相同或类似功能的元件。下面通过参考附图描述的实施方式是示例性的,仅用于解释本发明,而不能理解为对本发明的限制。
在本发明的描述中,需要理解的是,术语“中心”、“纵向”、“横向”、“长度”、“宽度”、“厚度”、“上”、“下”、“前”、“后”、“左”、“右”、“竖直”、“水平”、“顶”、“底”、“内”、“外”、“顺时针”、“逆时针”等指示的方位或位置关系为基于附图所示的方位或位置关系,仅是为了便于描述本发明和简化描述,而不是指示或暗示所指的装置或元件必须具有特定的方位、以特定的方位构造和操作,因此不能理解为对本发明的限制。此外,术语“第一”、“第二”仅用于描述目的,而不能理解为指示或暗示相对重要性或者隐含指明所指示的技术特征的数量。由此,限定有“第一”、“第二”的特征可以明示或者隐含地包括一个或者更多个所述特征。在本发明的描述中,“多个”的含义是两个或两个以上,除非另有明确具体的限定。
下文的公开提供的实施方式或例子用来实现本发明的不同结构。为了简化本发明的公开,下文中对特定例子的部件和设置进行描述。当然,它们仅仅为示例,并且目的不在于限制本发明。此外,本发明可以在不同例子中重复参考数字和/或参考字母,这种重复是为了简化和清楚的目的,其本身不指示所讨论各种实施方式和/或设置之间的关系。此外,本发明提供了的各种特定的工艺和材料的例子,但是本领域普通技术佩戴人员可以意识到其他工艺的应用和/或其他材料的使用。
请参阅图1,本申请实施例提供的一种矿区三维地图构建系统,包括无人机1、矿车2和多个路侧感知端3,所述无人机1、矿车2和路侧感知端3均包括激光雷达、差分GNSS导航设备、IMU惯性测量单元;
所述无人机1用于通过对应的(即自身的)激光雷达、差分GNSS导航设备、IMU惯性测量单元获取矿区全局的三维点云图作为底图,并发送至所述矿车2;
所述路侧感知端3设置在矿区道路的路侧,并用于通过对应的(即自身的)激光雷达、差分GNSS导航设备、IMU惯性测量单元获取路侧感知端所在区域(该区域的大小由激光雷达的有效检测范围觉得)的第一局部三维点云图,并发送至所述矿车2;
所述矿车2用于通过对应的(即自身的)激光雷达、差分GNSS导航设备、IMU惯性测量单元获取矿车2所在区域(该区域的大小由激光雷达的有效检测范围觉得)的第二局部三维点云图,把所述第一局部三维点云图和所述第二局部三维点云图进行融合,得到初步融合的局部三维点云图,然后把所述初步融合的局部三维点云图与所述底图进行融合得到融合的全局三维点云图。
其中,路侧感知端3的数量和具体设置位置可根据实际需要设置,例如可沿矿区道路延伸方向等间隔的设置路侧感知端3;也可在道路转弯处、矿车装货处、矿车卸货处等重要局部位置设置路侧感知端3,以保证矿车在转弯、装货、卸货时能够更精确地按规划的路线行驶。
使用该矿区三维地图构建系统,当矿区地形改变时,可通过无人机1方便快捷地得到矿区全局的三维点云图为底图,然后与路侧感知端3及矿车2实时获取的局部三维点云图进行融合得到全局三维点云图,与现有技术中仅靠车辆本身携带的设备进行扫描来构建三维地图的方式相比,三维地图构建更容易,构建速度更快,能够根据矿区地形变化情况更及时地更新三维地图;而且与现有技术中仅靠车辆本身携带的设备进行扫描来构建三维地图的方式相比,能够在扬尘环境中构建出更大范围的三维地图。
实际上,虽然由无人机1获得的底图的精度相对较低,但路侧感知端3及矿车2获得的局部三维点云图的精度较高,而且路侧感知端3及矿车2获得的局部三维点云图是与行车环境相关的重要局部位置的三维点云图,三者融合后的全局三维点云图足以满足矿车2的自动驾驶需求。该矿区三维地图构建系统具有以下优点:
1.针对矿区三维地图构建需要不定期使用车辆进行三维地图的重复采集构建,提出了一种以矿车局部建图为主,无人机协同和路侧感知端协同为辅的方案,可以有效的减少三维地图构建的周期,明显提高矿区作业效率;
2.通过矿车和路侧感知端对无人机获取的底图数据进行准实时更新,将矿区高精度三位地图的构建分成三部分进行融合完成,可以有效避免采用单一渠道进行三维地图构建的局限性;在扬尘环境,将矿车三维地图和路侧感知端三维地图进行互补融合可以有效提升三维地图构建的范围;
3.依靠路侧感知端的小时级更新与矿车的实时更新的特性,互补融合可以准实时动态地掌握矿区情况,相较于依靠车辆建图的模式,可以有效检测出矿车在运行过程中对前车落石以及周边滑坡情况,可以有效提升矿车作业的安全性。
需要说明的是,所述无人机1、矿车2和路侧感知端3均设置有通信模块(如4G/5G通信模块,但不限于此),无人机1、路侧感知端3和矿车2之间通过通信模块通信连接。
在一些优选实施方式中,参考图3,所述无人机1、矿车2和路侧感知端3在通过对应的(各自的)激光雷达、差分GNSS导航设备、IMU惯性测量单元获取对应的三维点云图的时候:
用激光雷达获取扫描点在激光雷达坐标系(以下称之为S系)中的坐标;
根据以下公式计算所述扫描点在地心直角坐标系(以下称之为E系)中的坐标:
其中,为扫描点在地心直角坐标系(E系)中的坐标;为对应的IMU惯性测量单元中心在地心直角坐标系中的坐标,该坐标可由差分GNSS导航设备和IMU惯性测量单元通过组合导航解算得到;为对应的IMU惯性测量单元坐标系(以下称之为I系)至地心直角坐标系的旋转矩阵,可由差分GNSS导航设备和IMU惯性测量单元测得的姿态(Pitch、Roll、Yaw)形成;为所述激光雷达的激光雷达坐标系中心到所述IMU惯性测量单元中心的偏置在所述IMU惯性测量单元坐标系中的分量,可事先测量得到;为所述激光雷达坐标系到所述IMU惯性测量单元坐标系的旋转矩阵,可事先标定得到;为所述扫描点在所述激光雷达坐标系中的坐标。
通过上述方式构建的三维点云图中的扫描点的坐标统一为在E系中的坐标,以便于后期的融合。
按照激光雷达距离越小精度越高的特性,矿车和路测感知端由于观测范围较小,所构建的局部三维点云图精度较高可以达到厘米级至毫米级,而各三维点云图中的扫描点的坐标统一为在E系中的坐标,因此路侧感知端获得的局部三维点云图和矿车获得的三维点云图可以直接进行拼接融合;从而,在一些实施方式中,所述矿车2在把所述第一局部三维点云图和所述第二局部三维点云图进行融合的时候:
基于各点在地心直角坐标系中的坐标,对所述第一局部三维点云图和所述第二局部三维点云图进行拼接。
拼接后的各扫描点在E系中的坐标值保持不变。
进一步地,由于矿区范围较大,激光扫描距离越远导致在无人机进行底图构建的时候精度相对较低,除此之外无人机飞行姿态的角度误差影响也导致无法直接通过直接地理参考信息(扫描点在E系中的坐标)进行点云拼接;从而,在一些实施方式中,所述矿车2在把所述初步融合的局部三维点云图与所述底图进行融合得到融合的全局三维点云图的时候:
采用基于ICP算法的点云匹配方式对所述初步融合的局部三维点云图与所述底图进行点云拼接。
ICP算法是最小二乘迭代优化的过程,主要方法为:首先寻找两帧点云数据中同名特征点,根据特征点迭代求解出对应点之间的运动参数,根据运动参数将不同参考系的激光点云准换到同一坐标系,实现两点云应该重叠的部分完全重叠。
具体地,所述矿车2在采用基于ICP算法的点云匹配方式对所述初步融合的局部三维点云图与所述底图进行点云拼接的时候,执行以下步骤:
根据以下公式计算总旋转矩阵、旋转向量和第n次迭代处理的旋转后的第一同名特征点集:
C3.根据以下公式对所述初步融合的局部三维点云图的各点进行转换处理,并用转换处理后的初步融合的局部三维点云图与所述底图进行拼接:
采用基于ICP算法的点云匹配方式进行点云图拼接融合的效果可参考图4-6,该示例中,采用EagleEye2000激光雷达以不同角度对同一厂区一角进行扫描,分别得到图5、6的两帧点云图,采用基于ICP算法的点云匹配方式进行点云图拼接融合后得到图4所示的点云图,其融合效果较好。
在一些实施方式中,步骤C1包括:
其中,可选定一些角点、特殊标记点(例如可在矿区中设置一些球状标记物、尖角状标记物等,以球状标记物的中心、尖角状标记物的尖点为特殊标记点)等点为特征点。Kd-tree算法为现有技术,能够比较准确第搜索到对应的同名特征点,此处不对其详细步骤进行描述。
在一些优选实施方式中,所述矿车2还用于对融合得到全局三维点云图进行点云滤波降噪处理,进一步提高全局三维点云图的精确性。
请参考图2,本申请实施例提供一种矿区三维地图构建方法,包括步骤:
A1.获取由无人机通过设置在所述无人机上的激光雷达、差分GNSS导航设备、IMU惯性测量单元获得的矿区全局的三维点云图作为底图;
A2.获取由路侧感知端通过设置在所述路侧感知端上的激光雷达、差分GNSS导航设备、IMU惯性测量单元获得的路侧感知端所在区域的第一局部三维点云图;所述路侧感知端设置在矿区道路的路侧;
A3.获取由矿车通过设置在所述矿车上的激光雷达、差分GNSS导航设备、IMU惯性测量单元获得的矿车所在区域的第二局部三维点云图;
A4.把所述第一局部三维点云图和所述第二局部三维点云图进行融合,得到初步融合的局部三维点云图;
A5.把所述初步融合的局部三维点云图与所述底图进行融合得到融合的全局三维点云图。
在一些实施方式中,该矿区三维地图构建方法可应用于上述矿区三维地图构建系统中的矿车2中。
使用该矿区三维地图构建方法,当矿区地形改变时,可通过无人机方便快捷地得到矿区全局的三维点云图为底图,然后与路侧感知端及矿车实时获取的局部三维点云图进行融合得到全局三维点云图,与现有技术中仅靠车辆本身携带的设备进行扫描来构建三维地图的方式相比,三维地图构建更容易,构建速度更快,能够根据矿区地形变化情况更及时地更新三维地图;而且与现有技术中仅靠车辆本身携带的设备进行扫描来构建三维地图的方式相比,能够在扬尘环境中构建出更大范围的三维地图。
实际上,虽然由无人机获得的底图的精度相对较低,但路侧感知端及矿车获得的局部三维点云图的精度较高,而且路侧感知端及矿车获得的局部三维点云图是与行车环境相关的重要局部位置的三维点云图,三者融合后的全局三维点云图足以满足矿车的自动驾驶需求。该矿区三维地图构建系统具有以下优点:
1.针对矿区三维地图构建需要不定期使用车辆进行三维地图的重复采集构建,提出了一种以矿车局部建图为主,无人机协同和路侧感知端协同为辅的方案,可以有效的减少三维地图构建的周期,明显提高矿区作业效率;
2.通过矿车和路侧感知端对无人机获取的底图数据进行准实时更新,将矿区高精度三位地图的构建分成三部分进行融合完成,可以有效避免采用单一渠道进行三维地图构建的局限性;在扬尘环境,将矿车三维地图和路侧感知端三维地图进行互补融合可以有效提升三维地图构建的范围;
3.依靠路侧感知端的小时级更新与矿车的实时更新的特性,互补融合可以准实时动态地掌握矿区情况,相较于依靠车辆建图的模式,可以有效检测出矿车在运行过程中对前车落石以及周边滑坡情况,可以有效提升矿车作业的安全性。
在一些优选实施方式中,参考图3,所述无人机、矿车和路侧感知端在通过对应的(各自的)激光雷达、差分GNSS导航设备、IMU惯性测量单元获取对应的三维点云图的时候:
用激光雷达获取扫描点在激光雷达坐标系(以下称之为S系)中的坐标;
根据以下公式计算所述扫描点在地心直角坐标系(以下称之为E系)中的坐标:
其中,为扫描点在地心直角坐标系(E系)中的坐标;为对应的IMU惯性测量单元中心在地心直角坐标系中的坐标,该坐标可由差分GNSS导航设备和IMU惯性测量单元通过组合导航解算得到;为对应的IMU惯性测量单元坐标系(以下称之为I系)至地心直角坐标系的旋转矩阵,可由差分GNSS导航设备和IMU惯性测量单元测得的姿态(Pitch、Roll、Yaw)形成;为所述激光雷达的激光雷达坐标系中心到所述IMU惯性测量单元中心的偏置在所述IMU惯性测量单元坐标系中的分量,可事先测量得到;为所述激光雷达坐标系到所述IMU惯性测量单元坐标系的旋转矩阵,可事先标定得到;为所述扫描点在所述激光雷达坐标系中的坐标。
通过上述方式构建的三维点云图中的扫描点的坐标统一为在E系中的坐标,以便于后期的融合。
按照激光雷达距离越小精度越高的特性,矿车和路测感知端由于观测范围较小,所构建的局部三维点云图精度较高可以达到厘米级至毫米级,而各三维点云图中的扫描点的坐标统一为在E系中的坐标,因此路侧感知端获得的局部三维点云图和矿车获得的三维点云图可以直接进行拼接融合;从而,在一些实施方式中,步骤A4包括:
基于各点在地心直角坐标系中的坐标,对所述第一局部三维点云图和所述第二局部三维点云图进行拼接。
进一步地,由于矿区范围较大,激光扫描距离越远导致在无人机进行底图构建的时候精度相对较低,除此之外无人机飞行姿态的角度误差影响也导致无法直接通过直接地理参考信息(扫描点在E系中的坐标)进行点云拼接;从而,在一些实施方式中,步骤A5包括:
采用基于ICP算法的点云匹配方式对所述初步融合的局部三维点云图与所述底图进行点云拼接。
ICP算法是最小二乘迭代优化的过程,主要方法为:首先寻找两帧点云数据中同名特征点,根据特征点迭代求解出对应点之间的运动参数,根据运动参数将不同参考系的激光点云准换到同一坐标系,实现两点云应该重叠的部分完全重叠。
具体地,所述采用基于ICP算法的点云匹配方式对所述初步融合的局部三维点云图与所述底图进行点云拼接的步骤包括:
根据以下公式计算总旋转矩阵、旋转向量和第n次迭代处理的旋转后的第一同名特征点集:
C3.根据以下公式对所述初步融合的局部三维点云图的各点进行转换处理,并用转换处理后的初步融合的局部三维点云图与所述底图进行拼接:
在一些实施方式中,步骤C1包括:
其中,可选定一些角点、特殊标记点(例如可在矿区中设置一些球状标记物、尖角状标记物等,以球状标记物的中心、尖角状标记物的尖点为特殊标记点)等点为特征点。Kd-tree算法为现有技术,能够比较准确第搜索到对应的同名特征点,此处不对其详细步骤进行描述。
在一些优选实施方式中,步骤A5之后,还包括步骤:
对融合得到全局三维点云图进行点云滤波降噪处理。
以进一步提高全局三维点云图的精确性。
综上所述,虽然本发明已以优选实施例揭露如上,但上述优选实施例并非用以限制本发明,本领域的普通技术佩戴人员,在不脱离本发明的精神和范围内,均可作各种更动与润饰,其方案与本发明实质上相同。
Claims (10)
1.一种矿区三维地图构建系统,其特征在于,包括无人机、矿车和多个路侧感知端,所述无人机、矿车和路侧感知端均包括激光雷达、差分GNSS导航设备、IMU惯性测量单元;
所述无人机用于通过对应的激光雷达、差分GNSS导航设备、IMU惯性测量单元获取矿区全局的三维点云图作为底图,并发送至所述矿车;
所述路侧感知端设置在矿区道路的路侧,并用于通过对应的激光雷达、差分GNSS导航设备、IMU惯性测量单元获取路侧感知端所在区域的第一局部三维点云图,并发送至所述矿车;
所述矿车用于通过对应的激光雷达、差分GNSS导航设备、IMU惯性测量单元获取矿车所在区域的第二局部三维点云图,把所述第一局部三维点云图和所述第二局部三维点云图进行融合,得到初步融合的局部三维点云图,然后把所述初步融合的局部三维点云图与所述底图进行融合得到融合的全局三维点云图。
2.根据权利要求1所述的矿区三维地图构建系统,其特征在于,所述无人机、矿车和路侧感知端在通过对应的激光雷达、差分GNSS导航设备、IMU惯性测量单元获取对应的三维点云图的时候:
用激光雷达获取扫描点在激光雷达坐标系中的坐标;
根据以下公式计算所述扫描点在地心直角坐标系中的坐标:
3.根据权利要求2所述的矿区三维地图构建系统,其特征在于,所述矿车在把所述第一局部三维点云图和所述第二局部三维点云图进行融合的时候:
基于各点在地心直角坐标系中的坐标,对所述第一局部三维点云图和所述第二局部三维点云图进行拼接。
4.根据权利要求1所述的矿区三维地图构建系统,其特征在于,所述矿车在把所述初步融合的局部三维点云图与所述底图进行融合得到融合的全局三维点云图的时候:
采用基于ICP算法的点云匹配方式对所述初步融合的局部三维点云图与所述底图进行点云拼接。
5.根据权利要求4所述的矿区三维地图构建系统,其特征在于,所述矿车在采用基于ICP算法的点云匹配方式对所述初步融合的局部三维点云图与所述底图进行点云拼接的时候,执行以下步骤:
根据以下公式计算总旋转矩阵、旋转向量和第n次迭代处理的旋转后的第一同名特征点集:
C3.根据以下公式对所述初步融合的局部三维点云图的各点进行转换处理,并用转换处理后的初步融合的局部三维点云图与所述底图进行拼接:
7.一种矿区三维地图构建方法,其特征在于,包括步骤:
A1.获取由无人机通过设置在所述无人机上的激光雷达、差分GNSS导航设备、IMU惯性测量单元获得的矿区全局的三维点云图作为底图;
A2.获取由路侧感知端通过设置在所述路侧感知端上的激光雷达、差分GNSS导航设备、IMU惯性测量单元获得的路侧感知端所在区域的第一局部三维点云图;所述路侧感知端设置在矿区道路的路侧;
A3.获取由矿车通过设置在所述矿车上的激光雷达、差分GNSS导航设备、IMU惯性测量单元获得的矿车所在区域的第二局部三维点云图;
A4.把所述第一局部三维点云图和所述第二局部三维点云图进行融合,得到初步融合的局部三维点云图;
A5.把所述初步融合的局部三维点云图与所述底图进行融合得到融合的全局三维点云图。
8.根据权利要求7所述的矿区三维地图构建方法,其特征在于,步骤A4包括:
基于各点在地心直角坐标系中的坐标,对所述第一局部三维点云图和所述第二局部三维点云图进行拼接。
9.根据权利要求7所述的矿区三维地图构建方法,其特征在于,步骤A5包括:
采用基于ICP算法的点云匹配方式对所述初步融合的局部三维点云图与所述底图进行点云拼接。
10.根据权利要求9所述的矿区三维地图构建方法,其特征在于,所述采用基于ICP算法的点云匹配方式对所述初步融合的局部三维点云图与所述底图进行点云拼接的步骤包括:
根据以下公式计算总旋转矩阵、旋转向量和第n次迭代处理的旋转后的第一同名特征点集:
C3.根据以下公式对所述初步融合的局部三维点云图的各点进行转换处理,并用转换处理后的初步融合的局部三维点云图与所述底图进行拼接:
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110920940.2A CN113706702A (zh) | 2021-08-11 | 2021-08-11 | 矿区三维地图构建系统和方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110920940.2A CN113706702A (zh) | 2021-08-11 | 2021-08-11 | 矿区三维地图构建系统和方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN113706702A true CN113706702A (zh) | 2021-11-26 |
Family
ID=78652351
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110920940.2A Pending CN113706702A (zh) | 2021-08-11 | 2021-08-11 | 矿区三维地图构建系统和方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113706702A (zh) |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115221260A (zh) * | 2022-07-18 | 2022-10-21 | 小米汽车科技有限公司 | 数据处理方法、装置、车辆及存储介质 |
CN115711618A (zh) * | 2022-11-03 | 2023-02-24 | 北京踏歌智行科技有限公司 | 一种基于路侧导引的矿区高精度定位方法 |
WO2023123837A1 (zh) * | 2021-12-30 | 2023-07-06 | 广州小鹏自动驾驶科技有限公司 | 地图的生成方法、装置、电子设备及存储介质 |
CN117518197A (zh) * | 2024-01-08 | 2024-02-06 | 太原理工大学 | 煤矿井下掘进巷道的轮廓标示方法 |
CN117706563A (zh) * | 2024-02-05 | 2024-03-15 | 中南大学 | 矿井垂直断面钻孔定位方法、系统、设备及存储介质 |
-
2021
- 2021-08-11 CN CN202110920940.2A patent/CN113706702A/zh active Pending
Cited By (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2023123837A1 (zh) * | 2021-12-30 | 2023-07-06 | 广州小鹏自动驾驶科技有限公司 | 地图的生成方法、装置、电子设备及存储介质 |
CN115221260A (zh) * | 2022-07-18 | 2022-10-21 | 小米汽车科技有限公司 | 数据处理方法、装置、车辆及存储介质 |
CN115221260B (zh) * | 2022-07-18 | 2024-02-09 | 小米汽车科技有限公司 | 数据处理方法、装置、车辆及存储介质 |
CN115711618A (zh) * | 2022-11-03 | 2023-02-24 | 北京踏歌智行科技有限公司 | 一种基于路侧导引的矿区高精度定位方法 |
CN117518197A (zh) * | 2024-01-08 | 2024-02-06 | 太原理工大学 | 煤矿井下掘进巷道的轮廓标示方法 |
CN117518197B (zh) * | 2024-01-08 | 2024-03-26 | 太原理工大学 | 煤矿井下掘进巷道的轮廓标示方法 |
CN117706563A (zh) * | 2024-02-05 | 2024-03-15 | 中南大学 | 矿井垂直断面钻孔定位方法、系统、设备及存储介质 |
CN117706563B (zh) * | 2024-02-05 | 2024-05-07 | 中南大学 | 矿井垂直断面钻孔定位方法、系统、设备及存储介质 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110057373B (zh) | 用于生成高精细语义地图的方法、装置和计算机存储介质 | |
CN113706702A (zh) | 矿区三维地图构建系统和方法 | |
EP3519770B1 (en) | Methods and systems for generating and using localisation reference data | |
US11143514B2 (en) | System and method for correcting high-definition map images | |
KR102698523B1 (ko) | 위치파악 참조 데이터를 생성하고 사용하는 방법 및 시스템 | |
EP3631494B1 (en) | Integrated sensor calibration in natural scenes | |
US8571265B2 (en) | Measurement apparatus, measurement method, and feature identification apparatus | |
CN110411457B (zh) | 基于行程感知与视觉融合的定位方法、系统、终端和存储介质 | |
CN112346463B (zh) | 一种基于速度采样的无人车路径规划方法 | |
CN112189225A (zh) | 车道线信息检测装置、方法以及存储被编程为执行该方法的计算机程序的计算机可读记录介质 | |
US20220035036A1 (en) | Method and apparatus for positioning movable device, and movable device | |
CN113834492A (zh) | 地图匹配方法、系统、设备及可读存储介质 | |
US11579622B2 (en) | Systems and methods for utilizing images to determine the position and orientation of a vehicle | |
JP2016045330A (ja) | 3次元点群データの位置合わせ方法と装置及びその移動体システム | |
CN110458885B (zh) | 基于行程感知与视觉融合的定位系统和移动终端 | |
Jende et al. | A fully automatic approach to register mobile mapping and airborne imagery to support the correction of platform trajectories in GNSS-denied urban areas | |
EP3452780B1 (en) | A method for improving position information associated with a collection of images |
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 |