CN113192142A - 复杂环境下的高精度地图构建方法、装置和计算机设备 - Google Patents
复杂环境下的高精度地图构建方法、装置和计算机设备 Download PDFInfo
- Publication number
- CN113192142A CN113192142A CN202110583178.3A CN202110583178A CN113192142A CN 113192142 A CN113192142 A CN 113192142A CN 202110583178 A CN202110583178 A CN 202110583178A CN 113192142 A CN113192142 A CN 113192142A
- Authority
- CN
- China
- Prior art keywords
- point cloud
- factor
- gnss
- imu
- cloud data
- 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
- 238000010276 construction Methods 0.000 title claims abstract description 20
- 239000011159 matrix material Substances 0.000 claims abstract description 66
- 230000015556 catabolic process Effects 0.000 claims abstract description 46
- 238000006731 degradation reaction Methods 0.000 claims abstract description 46
- 238000004458 analytical method Methods 0.000 claims abstract description 36
- 238000000034 method Methods 0.000 claims abstract description 34
- 238000007781 pre-processing Methods 0.000 claims abstract description 10
- 238000004590 computer program Methods 0.000 claims description 14
- 238000004422 calculation algorithm Methods 0.000 claims description 9
- 238000012545 processing Methods 0.000 claims description 8
- 238000006073 displacement reaction Methods 0.000 claims description 4
- 238000000605 extraction Methods 0.000 claims description 4
- 238000004445 quantitative analysis Methods 0.000 claims description 4
- 230000007850 degeneration Effects 0.000 claims description 3
- 238000005457 optimization Methods 0.000 description 11
- 230000008569 process Effects 0.000 description 10
- 238000010586 diagram Methods 0.000 description 7
- 230000006870 function Effects 0.000 description 5
- 238000013507 mapping Methods 0.000 description 5
- 230000009466 transformation Effects 0.000 description 5
- 238000004364 calculation method Methods 0.000 description 2
- 238000005516 engineering process Methods 0.000 description 2
- 238000010606 normalization Methods 0.000 description 2
- 230000001360 synchronised effect Effects 0.000 description 2
- 230000007704 transition Effects 0.000 description 2
- 230000003190 augmentative effect Effects 0.000 description 1
- 239000004973 liquid crystal related substance Substances 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000010355 oscillation Effects 0.000 description 1
- 238000002310 reflectometry Methods 0.000 description 1
- 230000003068 static effect Effects 0.000 description 1
- 238000013519 translation Methods 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06T—IMAGE DATA PROCESSING OR GENERATION, IN GENERAL
- G06T7/00—Image analysis
- G06T7/70—Determining position or orientation of objects or cameras
- G06T7/73—Determining position or orientation of objects or cameras using feature-based methods
- G06T7/75—Determining position or orientation of objects or cameras using feature-based methods involving models
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F16/00—Information retrieval; Database structures therefor; File system structures therefor
- G06F16/20—Information retrieval; Database structures therefor; File system structures therefor of structured data, e.g. relational data
- G06F16/29—Geographical information databases
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06T—IMAGE DATA PROCESSING OR GENERATION, IN GENERAL
- G06T5/00—Image enhancement or restoration
- G06T5/70—Denoising; Smoothing
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06T—IMAGE DATA PROCESSING OR GENERATION, IN GENERAL
- G06T5/00—Image enhancement or restoration
- G06T5/80—Geometric correction
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06T—IMAGE DATA PROCESSING OR GENERATION, IN GENERAL
- G06T2207/00—Indexing scheme for image analysis or image enhancement
- G06T2207/10—Image acquisition modality
- G06T2207/10028—Range image; Depth image; 3D point clouds
Landscapes
- Engineering & Computer Science (AREA)
- Theoretical Computer Science (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Databases & Information Systems (AREA)
- Remote Sensing (AREA)
- Data Mining & Analysis (AREA)
- General Engineering & Computer Science (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Processing Or Creating Images (AREA)
Abstract
本申请涉及一种复杂环境下的高精度地图构建方法、装置和计算机设备。所述方法包括:获取激光点云数据,对激光点云数据进行预处理,得到点云匹配因子和预处理点云数据;获取IMU导航数据以及GNSS导航数据,根据所述IMU导航数据以及GNSS导航数据,分别得到IMU边观测因子和GNSS点观测因子;对点云匹配因子、IMU边观测因子和GNSS点观测因子进行退化性分析,基于退化性分析结果设置表征不确定性的信息矩阵并构建因子图,对因子图进行优化,得到激光点云数据中每个关键帧的六自由度位姿信息,根据六自由度位姿信息对预处理点云数据进行拼接,得到高精度地图。采用本方法能够进行高精度地图构建。
Description
技术领域
本申请涉及地图生成技术领域,特别是涉及一种复杂环境下的高精度地图构建方法、装置和计算机设备。
背景技术
近年来,无人驾驶技术取得了飞速的进步。其中,高精度地图的构建和应用起到非常重要的作用。与传统地图相比,高精度地图不仅具有更高的准确性,而且能够提供更丰富的环境信息,为导航、规划等模块提供更大的帮助。
高精度地图需要同时满足全局准确性和局部准确性。在全局层面,地图要与全局坐标***一致;在局部层面,地图需要完全捕获周围环境的局部信息,地图精度应达到厘米级。为了满足这两个要求,地图构建***应将全局导航方法与局部导航方法相结合。其中,全局导航信息可以从全球卫星定位***获得(如北斗,GNSS,GPS等),局部导航信息可以从IMU、车轮编码器以及雷达里程计等途径获得。但是,在实际应用过程中,上述导航信息都可能出现退化的情况,因此导致构建的地图精确度不够高。
发明内容
基于此,有必要针对上述技术问题,提供一种能够解决地图精确度不够高的复杂环境下的高精度地图构建方法、装置和计算机设备。
一种复杂环境下的高精度地图构建方法,其特征在于,所述方法包括:
获取激光点云数据,对所述激光点云数据进行预处理,得到点云匹配因子和预处理点云数据;
获取IMU导航数据以及GNSS导航数据,根据所述IMU导航数据以及GNSS导航数据,分别得到IMU边观测因子和GNSS点观测因子;
对所述点云匹配因子、所述IMU边观测因子和所述GNSS点观测因子进行退化性分析,基于退化性分析结果设置表征不确定性的信息矩阵并构建因子图;
对所述因子图进行优化,得到激光点云数据中每个关键帧的六自由度位姿信息,根据所述六自由度位姿信息对所述预处理点云数据进行拼接,得到高精度地图。
在其中一个实施例中,还包括:根据预设的位移量,确定所述激光点云数据中的关键帧;采用点云帧内补偿算法对所述激光点云数据中由车体自运动形成的点云畸变进行处理,以及对所述激光点云数据中动态场景的点云噪声进行处理。
在其中一个实施例中,确定复杂环境的环境类型,根据环境类型确定退化分析类型;获取退化分析的退化指标,以及获取六自由度对角矩阵;根据所述退化指标、所述六自由度对角矩阵以及所述退化分析类型,得到点云匹配因子的第一信息矩阵。
在其中一个实施例中,根据GNSS导航数据对应的输出定位方差和可观测卫星数目,确定GNSS点观测因子对应的第二信息矩阵;采用运动模型估计方式进行量化分析,得到IMU边观测因子的第三信息矩阵;根据所述第一信息矩阵、所述第二信息矩阵以及所述第三信息矩阵,构建因子图。
在其中一个实施例中,高精度地图为二维高精度地图或三维高精度地图。
一种复杂环境下的高精度地图构建装置,所述装置包括:
数据获取模块,用于获取激光点云数据,对所述激光点云数据进行预处理,得到点云匹配因子和预处理点云数据;
因子提取模块,用于获取IMU导航数据以及GNSS导航数据,根据所述IMU导航数据以及GNSS导航数据,分别得到IMU边观测因子和GNSS点观测因子;
因子图构建模块,用于对所述点云匹配因子、所述IMU边观测因子和所述GNSS点观测因子进行退化性分析,基于退化性分析结果设置表征不确定性的信息矩阵并构建因子图;
地图生成模块,用于对所述因子图进行优化,得到激光点云数据中每个关键帧的六自由度位姿信息,根据所述六自由度位姿信息对所述预处理点云数据进行拼接,得到高精度地图。
一种计算机设备,包括存储器和处理器,所述存储器存储有计算机程序,所述处理器执行所述计算机程序时实现以下步骤:
获取激光点云数据,对所述激光点云数据进行预处理,得到点云匹配因子和预处理点云数据;
获取IMU导航数据以及GNSS导航数据,根据所述IMU导航数据以及GNSS导航数据,分别得到IMU边观测因子和GNSS点观测因子;
对所述点云匹配因子、所述IMU边观测因子和所述GNSS点观测因子进行退化性分析,基于退化性分析结果设置表征不确定性的信息矩阵并构建因子图;
对所述因子图进行优化,得到激光点云数据中每个关键帧的六自由度位姿信息,根据所述六自由度位姿信息对所述预处理点云数据进行拼接,得到高精度地图。
一种计算机可读存储介质,其上存储有计算机程序,所述计算机程序被处理器执行时实现以下步骤:
获取激光点云数据,对所述激光点云数据进行预处理,得到点云匹配因子和预处理点云数据;
获取IMU导航数据以及GNSS导航数据,根据所述IMU导航数据以及GNSS导航数据,分别得到IMU边观测因子和GNSS点观测因子;
对所述点云匹配因子、所述IMU边观测因子和所述GNSS点观测因子进行退化性分析,基于退化性分析结果设置表征不确定性的信息矩阵并构建因子图;
对所述因子图进行优化,得到激光点云数据中每个关键帧的六自由度位姿信息,根据所述六自由度位姿信息对所述预处理点云数据进行拼接,得到高精度地图。
上述复杂环境下的高精度地图构建方法、装置、计算机设备和存储介质,因子图采用概率框架,可以有效地处理不同导航源信息的不确定性,并且能够以灵活的方式整合不同的因子。我们全面分析了每种因子的状态,并且针对不同因子提出对应的退化状态估计方法。然后,根据退化程度调整因子对应的信息矩阵:具有较高置信度的因子获得更高的权重,在优化过程中不易被调整;置信度较低的因子在很大程度上被削弱,从而大大的提高了地图构建的精度。
附图说明
图1为一个实施例中复杂环境下的高精度地图构建方法的示意性流程图;
图2为一个实施例中位姿图优化框架的示意图;
图3为一个实施例中高精度建图结果示意图;其中,(a)表示三维地图,(b)表示二维障碍地图,(c)表示二维反射率地图;
图4为一个实施例中复杂环境下的高精度地图构建装置的结构框图;
图5为一个实施例中计算机设备的内部结构图。
具体实施方式
为了使本申请的目的、技术方案及优点更加清楚明白,以下结合附图及实施例,对本申请进行进一步详细说明。应当理解,此处描述的具体实施例仅仅用以解释本申请,并不用于限定本申请。
在一个实施例中,如图1所示,提供了一种复杂环境下的高精度地图构建方法,包括以下步骤:
步骤102,获取激光点云数据,对激光点云数据进行预处理,得到点云匹配因子和预处理点云数据。
激光点云数据是激光雷达获取得到的数据,通过对激光点云数据的预处理,即可以得到预处理点云数据,也可以通过帧内和帧间的信息,得到点云匹配因子。
步骤104,获取IMU导航数据以及GNSS导航数据,根据IMU导航数据以及GNSS导航数据,分别得到IMU边观测因子和GNSS点观测因子。
步骤106,对点云匹配因子、IMU边观测因子和GNSS点观测因子进行退化性分析,基于退化性分析结果设置表征不确定性的信息矩阵并构建因子图。
步骤108,对因子图进行优化,得到激光点云数据中每个关键帧的六自由度位姿信息,根据六自由度位姿信息对预处理点云数据进行拼接,得到高精度地图。
上述复杂环境下的高精度地图构建方法中,因子图采用概率框架,可以有效地处理不同导航源信息的不确定性,并且能够以灵活的方式整合不同的因子。我们全面分析了每种因子的状态,并且针对不同因子提出对应的退化状态估计方法。然后,根据退化程度调整因子对应的信息矩阵:具有较高置信度的因子获得更高的权重,在优化过程中不易被调整;置信度较低的因子在很大程度上被削弱,从而大大的提高了地图构建的精度。
在其中一个实施例中,在本发明中应用的位姿图优化框架进行解释,在该位姿图优化框架中,不同于传统的因子,本发明是对各个因子进行退化分析后,具有一定的不确定性的因子,具体过程如下:
该框架输入关键帧位姿节点信息、由传感器获得的关联位姿节点的约束以及每个约束对应的信息矩阵(也称为置信度矩阵),输出优化后的位姿,本发明中采用的约束包括以下三类:
(1)由GNSS、GPS或北斗卫星导航***提供的全局观测约束(也称为点约束),记为Zk。点约束可以通过传感器直接获得,在差分状态良好的情况下,GNSS可以提供厘米级的观测精度。
(2)局部相邻帧约束(也称短边约束),记为局部边约束又可以分为三种,第一种是由码盘/IMU递推得到局部车体运动估计,记为第二种是由相邻帧点云之间的匹配(scan-to-scan)获得的位姿约束,记为 第三种是由当前帧点云与邻近子图之间的匹配(scan-to-submap)获得的位姿约束,记为
假设图2中的约束之间相互独立,基于贝叶斯推理,全概率的表达式为:
Zk=Hk(Xk)+wk
其中,Zk代表GNSS/INS观测到的关联Xk的全局约束,Hk代表观测方程,wk为对应的观测噪声,设置为协方差为Λk的零均值噪声。
因此,结合上式,可以将位姿图优化问题转化为最小二乘问题为:
其中,将Λ-1/2简记为Ω,ΩE和ΩZ分别表示边观测约束和点观测约束的信息矩阵。Ω表征了因子的置信度水平,可以通过标准差的逆矩阵求解。为了简化计算,Ω通常表示为6×6的对角阵,换言之,节点位姿X的具有独立的六个自由度分量为横向位置、纵向位置、高度、横滚角、俯仰角和偏航角。
基于以上实施例的说明,本发明采用的是表征不确定性的信息矩阵并构建因子图,因此可以提高建图的鲁棒性。
对于步骤102,在其中一个实施例中,对所述激光点云数据进行预处理,包括:根据预设的位移量,确定所述激光点云数据中的关键帧;采用点云帧内补偿算法对激光点云数据中运动形成的点云畸变进行处理,以及对激光点云数据中动态场景的点云噪声进行处理。
对于步骤106,在其中一个实施例中,对点云匹配因子、IMU边观测因子和GNSS点观测因子进行退化性分析,包括:确定复杂环境的环境类型,根据环境类型确定退化分析类型;获取退化分析的退化指标,以及获取六自由度对角矩阵;根据退化指标、六自由度对角矩阵以及退化分析类型,得到点云匹配因子的第一信息矩阵。
本发明中,在得到激光点云数据,扫描匹配的目的是估计目标点云P和参考点云Q之间的相对变换T。根据参考点云Q的不同类型,扫描匹配因子可分为如下三种形式:当Q是相邻的关键帧点云,该因子为帧到帧(scan-to-scan)匹配因子;当Q是相邻的局部子图,该因子为帧到子图(scan-to-subscan)匹配因子;当Q是重新访问的历史点云,该因子为闭环(loop-closure)匹配因子。点云匹配约束可以通过ICP、NDT、CSM以及LOAM等扫描匹配算法求解,为了兼顾匹配算法的效率和精度,采用基于LOAM的点云匹配方法。该方法首先从P和Q中提取特征点,然后分别将边缘特征和平面特征与对应的直线和平面进行关联,构建目标函数,最后通过迭代求解最优变换矩阵。
匹配算法的优化目标是求解最优变换矩阵:
T=[R|t]
使得以下能量函数最小:
其中,Se和Sp分别表示成功关联的边缘特征点集合和平面特征点集合,di表示特征点到直线的距离,dh表示特征点到平面的距离。
最优匹配T求解可以表示为:
由此将点云配准问题转化为非线性优化问题,采用Levenberg-Marquardt方法迭代求解:
δ=-(JTJ+λdiag(JTJ))-1JTd
T←T+δ
其中,为Nf×6的雅各比矩阵,Nf为成功关联的特征点数目,d为Nf×1的矩阵,上述优化求解过程以两个线程同时进行,第一个线程以高频模式求解相邻帧的变换矩阵(scan-to-scan);第二个线程以低频模式求解当前帧到累积子图的变换矩阵(scan-to-submap)。前者保证了算法的实时性,后者提高了匹配的精度。
在进行退化性分析时,JTJ的最小特征值可以表征为匹配的退化程度,该退化指标被定义为:
D=λm+1
其中,λm表示JTJ的最小特征值。
在本发明中,应用于多种匹配算法,且充分考虑了匹配过程的迭代情况,该方法的思路是:统计更新向量δ在优化过程中的振荡情况,对于退化情况,δ的波动较大,反之波动较小,因此记录每次迭代的更新向量δk,统计其协方差矩阵∑δ,∑δ的求解方式如下:
统计n次迭代情况,计算其协方差矩阵如下:
Δ=[δ1,δ2,···,δn]
∑δ=Δ·ΔT
对于步骤106,在其中一个实施例中,基于退化性分析结果设置表征不确定性的信息矩阵并构建因子图,包括:根据GNSS导航数据对应的输出定位方差和可观测卫星数目,确定GNSS点观测因子对应的第二信息矩阵;采用运动模型估计方式进行量化分析,得到IMU边观测因子的第三信息矩阵;根据第一信息矩阵、第二信息矩阵以及第三信息矩阵,构建因子图。
具体的,当其中一个自由度出现退化时,∑δ′中的分量会增大,因此也容易被整合到图优化框架中,再次基础上,将D与∑δ′结合,实现自动调节的,具体第一信息矩阵如下:
其中,当D≥Dt时,s(x)=1,反之,s(x)=-1,Dt为阈值。
具体的,对于40线和64线激光雷达,Dt可以设置为300,对于16线激光雷达,Dt可以设置为200,r1和r2可以分别设置为0.75和0.25,ξE为归一化函数,c∈{1,2,3}。
但是,本发明的具体设置不限制于此,还与环境类型有关,例如在越野场景下,为了提高点云匹配精度和鲁棒性,采用LOAM和CSM相结合的方式,得到第一信息矩阵为:
Sc表示由CSM得到的匹配得分值。
对于第二信息矩阵,在其中一个实施例中,的全局观测信息为GNSS/INS组合***输出的6自由度全局位姿,其观测方程已知。然而,GNSS/INS容易被高楼和树木遮挡信号,导致定位精度降低。除了6自由度全局位姿外,GNSS/INS组合设备同时输出定位方差和可观测的卫星数目,输出定位方差和可观测的卫星数目与定位精度相关,因此,计算得到的第二信息矩阵如下:
I=diag(ηt,ηt,ηt,ηr,ηr,ηr)
其中,ηt表示平移权重,ηr表示旋转权重,二者满足ηr=5·ηt。
经过因子图优化后的位姿X*将预处理后的点云拼接成全局一致地图。优化后的位姿输出是三维的,因此,该***可以同时生成高精度的三维地图和二维灰度图。为了提高地图的存取效率和方便地图更新,将整个地图依据全局位置划分成小块,每个小块采用单独的文件存储。对于三维高精度地图,采用八叉树的结构存储数据,并通过二进制流实现对八叉树的编码,有效地降低了地图存储的占用空间。对于二维灰度图,采用二维占据栅格的存储结构,根据栅格内存放的数据,可以分为二维高度地图(高程信息)和二维反射率地图(反射强度信息),如图3所示。
应该理解的是,虽然图1流程图中的各个步骤按照箭头的指示依次显示,但是这些步骤并不是必然按照箭头指示的顺序依次执行。除非本文中有明确的说明,这些步骤的执行并没有严格的顺序限制,这些步骤可以以其它的顺序执行。而且,图1的至少一部分步骤可以包括多个子步骤或者多个阶段,这些子步骤或者阶段并不必然是在同一时刻执行完成,而是可以在不同的时刻执行,这些子步骤或者阶段的执行顺序也不必然是依次进行,而是可以与其它步骤或者其它步骤的子步骤或者阶段的至少一部分轮流或者交替地执行。
在一个实施例中,如图4所示,提供了一种复杂环境下的高精度地图构建装置,包括:数据获取模块402、因子提取模块404、因子图构建模块406和地图生成模块408,其中:
数据获取模块402,用于获取激光点云数据,对所述激光点云数据进行预处理,得到点云匹配因子和预处理点云数据;
因子提取模块404,用于获取IMU导航数据以及GNSS导航数据,根据所述IMU导航数据以及GNSS导航数据,分别得到IMU边观测因子和GNSS点观测因子;
因子图构建模块406,用于对所述点云匹配因子、所述IMU边观测因子和所述GNSS点观测因子进行退化性分析,基于退化性分析结果设置表征不确定性的信息矩阵并构建因子图;
地图生成模块408,用于对所述因子图进行优化,得到激光点云数据中每个关键帧的六自由度位姿信息,根据所述六自由度位姿信息对所述预处理点云数据进行拼接,得到高精度地图。
在其中一个实施例中,数据获取模块402还用于根据预设的位移量,确定所述激光点云数据中的关键帧;采用点云帧内补偿算法对所述激光点云数据中运动形成的点云畸变进行处理,以及对所述激光点云数据中动态场景的点云噪声进行处理。
在其中一个实施例中,因子图构建模块406还用于确定复杂环境的环境类型,根据环境类型确定退化分析类型;获取退化分析的退化指标,以及获取六自由度对角矩阵;根据所述退化指标、所述六自由度对角矩阵以及所述退化分析类型,得到点云匹配因子的第一信息矩阵。
在其中一个实施例中,因子图构建模块406还用于根据GNSS导航数据对应的输出定位方差和可观测卫星数目,确定GNSS点观测因子对应的第二信息矩阵;采用运动模型估计方式进行量化分析,得到IMU边观测因子的第三信息矩阵;根据所述第一信息矩阵、所述第二信息矩阵以及所述第三信息矩阵,构建因子图。
在其中一个实施例中,所述高精度地图为二维高精度地图或三维高精度地图。
关于复杂环境下的高精度地图构建装置的具体限定可以参见上文中对于复杂环境下的高精度地图构建方法的限定,在此不再赘述。上述复杂环境下的高精度地图构建装置中的各个模块可全部或部分通过软件、硬件及其组合来实现。上述各模块可以硬件形式内嵌于或独立于计算机设备中的处理器中,也可以以软件形式存储于计算机设备中的存储器中,以便于处理器调用执行以上各个模块对应的操作。
在一个实施例中,提供了一种计算机设备,该计算机设备可以是终端,其内部结构图可以如图5所示。该计算机设备包括通过***总线连接的处理器、存储器、网络接口、显示屏和输入装置。其中,该计算机设备的处理器用于提供计算和控制能力。该计算机设备的存储器包括非易失性存储介质、内存储器。该非易失性存储介质存储有操作***和计算机程序。该内存储器为非易失性存储介质中的操作***和计算机程序的运行提供环境。该计算机设备的网络接口用于与外部的终端通过网络连接通信。该计算机程序被处理器执行时以实现一种复杂环境下的高精度地图构建方法。该计算机设备的显示屏可以是液晶显示屏或者电子墨水显示屏,该计算机设备的输入装置可以是显示屏上覆盖的触摸层,也可以是计算机设备外壳上设置的按键、轨迹球或触控板,还可以是外接的键盘、触控板或鼠标等。
本领域技术人员可以理解,图5中示出的结构,仅仅是与本申请方案相关的部分结构的框图,并不构成对本申请方案所应用于其上的计算机设备的限定,具体的计算机设备可以包括比图中所示更多或更少的部件,或者组合某些部件,或者具有不同的部件布置。
在一个实施例中,提供了一种计算机设备,包括存储器和处理器,该存储器存储有计算机程序,该处理器执行计算机程序时实现上述实施例中方法的步骤。
在一个实施例中,提供了一种计算机可读存储介质,其上存储有计算机程序,计算机程序被处理器执行时实现上述实施例中方法的步骤。
本领域普通技术人员可以理解实现上述实施例方法中的全部或部分流程,是可以通过计算机程序来指令相关的硬件来完成,所述的计算机程序可存储于一非易失性计算机可读取存储介质中,该计算机程序在执行时,可包括如上述各方法的实施例的流程。其中,本申请所提供的各实施例中所使用的对存储器、存储、数据库或其它介质的任何引用,均可包括非易失性和/或易失性存储器。非易失性存储器可包括只读存储器(ROM)、可编程ROM(PROM)、电可编程ROM(EPROM)、电可擦除可编程ROM(EEPROM)或闪存。易失性存储器可包括随机存取存储器(RAM)或者外部高速缓冲存储器。作为说明而非局限,RAM以多种形式可得,诸如静态RAM(SRAM)、动态RAM(DRAM)、同步DRAM(SDRAM)、双数据率SDRAM(DDRSDRAM)、增强型SDRAM(ESDRAM)、同步链路(Synchlink)DRAM(SLDRAM)、存储器总线(Rambus)直接RAM(RDRAM)、直接存储器总线动态RAM(DRDRAM)、以及存储器总线动态RAM(RDRAM)等。
以上实施例的各技术特征可以进行任意的组合,为使描述简洁,未对上述实施例中的各个技术特征所有可能的组合都进行描述,然而,只要这些技术特征的组合不存在矛盾,都应当认为是本说明书记载的范围。
以上所述实施例仅表达了本申请的几种实施方式,其描述较为具体和详细,但并不能因此而理解为对发明专利范围的限制。应当指出的是,对于本领域的普通技术人员来说,在不脱离本申请构思的前提下,还可以做出若干变形和改进,这些都属于本申请的保护范围。因此,本申请专利的保护范围应以所附权利要求为准。
Claims (8)
1.一种复杂环境下的高精度地图构建方法,其特征在于,所述方法包括:
获取激光点云数据,对所述激光点云数据进行预处理,得到点云匹配因子和预处理点云数据;
获取IMU导航数据以及GNSS导航数据,根据所述IMU导航数据以及GNSS导航数据,分别得到IMU边观测因子和GNSS点观测因子;
对所述点云匹配因子、所述IMU边观测因子和所述GNSS点观测因子进行退化性分析,基于退化性分析结果设置表征不确定性的信息矩阵并构建因子图;
对所述因子图进行优化,得到激光点云数据中每个关键帧的六自由度位姿信息,根据所述六自由度位姿信息对所述预处理点云数据进行拼接,得到高精度地图。
2.根据权利要求1所述的方法,其特征在于,对所述激光点云数据进行预处理,包括:
根据预设的位移量,确定所述激光点云数据中的关键帧;
采用点云帧内补偿算法对所述激光点云数据中由车体自运动形成的点云畸变进行处理,以及对所述激光点云数据中动态场景的点云噪声进行处理。
3.根据权利要求1所述的方法,其特征在于,对所述点云匹配因子、所述IMU边观测因子和所述GNSS点观测因子进行退化性分析,包括:
确定复杂环境的环境类型,根据环境类型确定退化分析类型;
获取退化分析的退化指标,以及获取六自由度对角矩阵;
根据所述退化指标、所述六自由度对角矩阵以及所述退化分析类型,得到点云匹配因子的第一信息矩阵。
4.根据权利要求3所述的方法,其特征在于,基于退化性分析结果设置表征不确定性的信息矩阵并构建因子图,包括:
根据GNSS导航数据对应的输出定位方差和可观测卫星数目,确定GNSS点观测因子对应的第二信息矩阵;
采用运动模型估计方式进行量化分析,得到IMU边观测因子的第三信息矩阵;
根据所述第一信息矩阵、所述第二信息矩阵以及所述第三信息矩阵,构建因子图。
5.根据权利要求1至4任一项所述的方法,其特征在于,所述高精度地图为二维高精度地图或三维高精度地图。
6.一种复杂环境下的高精度地图构建装置,其特征在于,所述装置包括:
数据获取模块,用于获取激光点云数据,对所述激光点云数据进行预处理,得到点云匹配因子和预处理点云数据;
因子提取模块,用于获取IMU导航数据以及GNSS导航数据,根据所述IMU导航数据以及GNSS导航数据,分别得到IMU边观测因子和GNSS点观测因子;
因子图构建模块,用于对所述点云匹配因子、所述IMU边观测因子和所述GNSS点观测因子进行退化性分析,基于退化性分析结果设置表征不确定性的信息矩阵并构建因子图;
地图生成模块,用于对所述因子图进行优化,得到激光点云数据中每个关键帧的六自由度位姿信息,根据所述六自由度位姿信息对所述预处理点云数据进行拼接,得到高精度地图。
7.一种计算机设备,包括存储器和处理器,所述存储器存储有计算机程序,其特征在于,所述处理器执行所述计算机程序时实现权利要求1至5中任一项所述方法的步骤。
8.一种计算机可读存储介质,其上存储有计算机程序,其特征在于,所述计算机程序被处理器执行时实现权利要求1至5中任一项所述的方法的步骤。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110583178.3A CN113192142A (zh) | 2021-05-27 | 2021-05-27 | 复杂环境下的高精度地图构建方法、装置和计算机设备 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110583178.3A CN113192142A (zh) | 2021-05-27 | 2021-05-27 | 复杂环境下的高精度地图构建方法、装置和计算机设备 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN113192142A true CN113192142A (zh) | 2021-07-30 |
Family
ID=76985394
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110583178.3A Pending CN113192142A (zh) | 2021-05-27 | 2021-05-27 | 复杂环境下的高精度地图构建方法、装置和计算机设备 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113192142A (zh) |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114115263A (zh) * | 2021-11-19 | 2022-03-01 | 武汉万集光电技术有限公司 | 用于agv的自主建图方法、装置、移动机器人及介质 |
CN114549605A (zh) * | 2021-12-31 | 2022-05-27 | 广州景骐科技有限公司 | 基于点云匹配的图像优化方法、装置、设备及存储介质 |
CN115079202A (zh) * | 2022-06-16 | 2022-09-20 | 智道网联科技(北京)有限公司 | 激光雷达建图方法、装置及电子设备、存储介质 |
CN115371662A (zh) * | 2022-08-22 | 2022-11-22 | 北京化工大学 | 一种基于概率栅格移除动态对象的静态地图构建方法 |
CN115790618A (zh) * | 2022-11-03 | 2023-03-14 | 中科天极(新疆)空天信息有限公司 | 基于激光雷达的slam定位方法、***及存储介质 |
-
2021
- 2021-05-27 CN CN202110583178.3A patent/CN113192142A/zh active Pending
Non-Patent Citations (1)
Title |
---|
RUIKE REN 等: "Towards a Fully Automated 3D Reconstruction System Based on LiDAR and GNSS in Challenging Scenarios", 《REMOTE SENSING》 * |
Cited By (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114115263A (zh) * | 2021-11-19 | 2022-03-01 | 武汉万集光电技术有限公司 | 用于agv的自主建图方法、装置、移动机器人及介质 |
CN114115263B (zh) * | 2021-11-19 | 2024-04-09 | 武汉万集光电技术有限公司 | 用于agv的自主建图方法、装置、移动机器人及介质 |
CN114549605A (zh) * | 2021-12-31 | 2022-05-27 | 广州景骐科技有限公司 | 基于点云匹配的图像优化方法、装置、设备及存储介质 |
CN114549605B (zh) * | 2021-12-31 | 2023-08-04 | 广州景骐科技有限公司 | 基于点云匹配的图像优化方法、装置、设备及存储介质 |
CN115079202A (zh) * | 2022-06-16 | 2022-09-20 | 智道网联科技(北京)有限公司 | 激光雷达建图方法、装置及电子设备、存储介质 |
CN115371662A (zh) * | 2022-08-22 | 2022-11-22 | 北京化工大学 | 一种基于概率栅格移除动态对象的静态地图构建方法 |
CN115371662B (zh) * | 2022-08-22 | 2024-06-25 | 北京化工大学 | 一种基于概率栅格移除动态对象的静态地图构建方法 |
CN115790618A (zh) * | 2022-11-03 | 2023-03-14 | 中科天极(新疆)空天信息有限公司 | 基于激光雷达的slam定位方法、***及存储介质 |
CN115790618B (zh) * | 2022-11-03 | 2023-09-01 | 中科天极(新疆)空天信息有限公司 | 基于激光雷达的slam定位方法、***及存储介质 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN113192142A (zh) | 复杂环境下的高精度地图构建方法、装置和计算机设备 | |
CN111208492B (zh) | 车载激光雷达外参标定方法及装置、计算机设备及存储介质 | |
Li et al. | Building and optimization of 3D semantic map based on Lidar and camera fusion | |
JP7316310B2 (ja) | 測位方法、装置、コンピューティングデバイス、およびコンピュータ可読記憶媒体 | |
Ho et al. | Virtual occupancy grid map for submap-based pose graph SLAM and planning in 3D environments | |
CN112444246B (zh) | 高精度的数字孪生场景中的激光融合定位方法 | |
CN113108773A (zh) | 一种融合激光与视觉传感器的栅格地图构建方法 | |
CN112835064B (zh) | 一种建图定位方法、***、终端及介质 | |
CN113110455A (zh) | 一种未知初始状态的多机器人协同探索方法、装置及*** | |
CN114001733A (zh) | 一种基于地图的一致性高效视觉惯性定位算法 | |
WO2023164933A1 (zh) | 一种建筑物建模方法以及相关装置 | |
EP3842836A1 (en) | Method, apparatus and storage medium for positioning object | |
CN113759364A (zh) | 一种基于激光地图的毫米波雷达连续定位方法及装置 | |
CN114047766B (zh) | 面向室内外场景长期应用的移动机器人数据采集***及方法 | |
CN111025229B (zh) | 一种水下机器人纯方位目标估计方法 | |
Zhao et al. | Conic feature based simultaneous localization and mapping in open environment via 2D lidar | |
CN114111791B (zh) | 一种智能机器人室内自主导航方法、***及存储介质 | |
CN117367412B (zh) | 一种融合捆集调整的紧耦合激光惯导里程计与建图方法 | |
Choi et al. | Fast and versatile feature-based lidar odometry via efficient local quadratic surface approximation | |
CN115164887A (zh) | 基于激光雷达与惯性组合的行人导航定位方法和装置 | |
CN113516772B (zh) | 三维场景重建方法及装置、bim模型的优化方法及装置 | |
CN113379915B (zh) | 一种基于点云融合的行车场景构建方法 | |
CN114674320A (zh) | 基于粒子滤波的定位方法、***、设备及存储介质 | |
Dai et al. | Improved Grid-Based Rao-Blackwellized Particle Filter SLAM Based on Grey Wolf Optimizer | |
Escourrou et al. | Ndt localization with 2d vector maps and filtered lidar scans |
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 | ||
RJ01 | Rejection of invention patent application after publication | ||
RJ01 | Rejection of invention patent application after publication |
Application publication date: 20210730 |