CN113192142A - 复杂环境下的高精度地图构建方法、装置和计算机设备 - Google Patents

复杂环境下的高精度地图构建方法、装置和计算机设备 Download PDF

Info

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
Application number
CN202110583178.3A
Other languages
English (en)
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.)
National University of Defense Technology
Original Assignee
National University of Defense 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 National University of Defense Technology filed Critical National University of Defense Technology
Priority to CN202110583178.3A priority Critical patent/CN113192142A/zh
Publication of CN113192142A publication Critical patent/CN113192142A/zh
Pending legal-status Critical Current

Links

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)局部相邻帧约束(也称短边约束)，记为
Figure BDA0003086902340000051
局部边约束又可以分为三种，第一种是由码盘/IMU递推得到局部车体运动估计，记为
Figure BDA0003086902340000052
第二种是由相邻帧点云之间的匹配(scan-to-scan)获得的位姿约束，记为
Figure BDA0003086902340000053
Figure BDA0003086902340000054
第三种是由当前帧点云与邻近子图之间的匹配(scan-to-submap)获得的位姿约束，记为
Figure BDA0003086902340000061
(3)闭环约束，采用时间相距较远且空间邻近的点云之间的匹配获得的位姿约束(也称长边约束)，记为
Figure BDA0003086902340000062
假设图2中的约束之间相互独立，基于贝叶斯推理，全概率的表达式为：
Figure BDA0003086902340000063
其中，X代表待优化的节点位姿，Z代表全局观测约束，E代表局部相邻帧约束和闭环约束，进一步的，
Figure BDA0003086902340000064
对应的状态转移矩阵可以描述为：
Figure BDA0003086902340000065
其中，Xi和Xj表示节点位姿，
Figure BDA0003086902340000066
表示用于连接两个节点约束，
Figure BDA0003086902340000067
表示状态转移过程函数，
Figure BDA0003086902340000068
表示
Figure BDA0003086902340000069
的噪声，若
Figure BDA00030869023400000610
为零均值高斯噪声，其协方差矩阵表示为
Figure BDA00030869023400000611
指约束类型，p(Zk|Xk)对应的观测模型为：
Zk＝Hk(Xk)+wk
其中，Zk代表GNSS/INS观测到的关联Xk的全局约束，Hk代表观测方程，wk为对应的观测噪声，设置为协方差为Λk的零均值噪声。
因此，结合上式，可以将位姿图优化问题转化为最小二乘问题为：
Figure BDA00030869023400000612
其中，
Figure BDA00030869023400000613
将Λ-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]
使得以下能量函数最小：
Figure BDA0003086902340000071
其中，Se和Sp分别表示成功关联的边缘特征点集合和平面特征点集合，di表示特征点到直线的距离，dh表示特征点到平面的距离。
最优匹配T求解可以表示为：
Figure BDA0003086902340000081
由此将点云配准问题转化为非线性优化问题，采用Levenberg-Marquardt方法迭代求解：
δ＝-(JTJ+λdiag(JTJ))-1JTd
T←T+δ
其中，
Figure BDA0003086902340000082
为Nf×6的雅各比矩阵，Nf为成功关联的特征点数目，d为Nf×1的矩阵，上述优化求解过程以两个线程同时进行，第一个线程以高频模式求解相邻帧的变换矩阵(scan-to-scan)；第二个线程以低频模式求解当前帧到累积子图的变换矩阵(scan-to-submap)。前者保证了算法的实时性，后者提高了匹配的精度。
在进行退化性分析时，JTJ的最小特征值可以表征为匹配的退化程度，该退化指标被定义为：
D＝λm+1
其中，λm表示JTJ的最小特征值。
在本发明中，应用于多种匹配算法，且充分考虑了匹配过程的迭代情况，该方法的思路是：统计更新向量δ在优化过程中的振荡情况，对于退化情况，δ的波动较大，反之波动较小，因此记录每次迭代的更新向量δk，统计其协方差矩阵∑δ，∑δ的求解方式如下：
统计n次迭代情况，计算其协方差矩阵如下：
Figure BDA0003086902340000083
Δ＝[δ1,δ2,···,δn]
∑δ＝Δ·ΔT
其中，
Figure BDA0003086902340000084
表示第k次迭代过程中六自由度位姿更新量，∑δ可以简写为对角矩阵：
Figure BDA0003086902340000091
对于步骤106，在其中一个实施例中，基于退化性分析结果设置表征不确定性的信息矩阵并构建因子图，包括：根据GNSS导航数据对应的输出定位方差和可观测卫星数目，确定GNSS点观测因子对应的第二信息矩阵；采用运动模型估计方式进行量化分析，得到IMU边观测因子的第三信息矩阵；根据第一信息矩阵、第二信息矩阵以及第三信息矩阵，构建因子图。
具体的，当其中一个自由度出现退化时，∑δ′中的分量会增大，因此也容易被整合到图优化框架中，再次基础上，将D与∑δ′结合，实现自动调节的，具体第一信息矩阵如下：
Figure BDA0003086902340000092
其中，当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相结合的方式，得到第一信息矩阵为：
Figure BDA0003086902340000093
Sc表示由CSM得到的匹配得分值。
对于第二信息矩阵，在其中一个实施例中，的全局观测信息为GNSS/INS组合系统输出的6自由度全局位姿，其观测方程已知。然而，GNSS/INS容易被高楼和树木遮挡信号，导致定位精度降低。除了6自由度全局位姿外，GNSS/INS组合设备同时输出定位方差和可观测的卫星数目，输出定位方差和可观测的卫星数目与定位精度相关，因此，计算得到的第二信息矩阵如下：
Figure BDA0003086902340000101
其中，
Figure BDA0003086902340000102
为预先设置好的阈值，例如取值可以是10，ξZ是归一化函数。I为6×6对角矩阵，定义如下：
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中任一项所述的方法的步骤。
CN202110583178.3A 2021-05-27 2021-05-27 复杂环境下的高精度地图构建方法、装置和计算机设备 Pending CN113192142A (zh)

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)

* Cited by examiner, † Cited by third party
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定位方法、系统及存储介质

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
RUIKE REN 等: "Towards a Fully Automated 3D Reconstruction System Based on LiDAR and GNSS in Challenging Scenarios", 《REMOTE SENSING》 *

Cited By (8)

* Cited by examiner, † Cited by third party
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 北京化工大学 一种基于概率栅格移除动态对象的静态地图构建方法
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) 车载激光雷达外参标定方法及装置、计算机设备及存储介质
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) 一种建图定位方法、系统、终端及介质
CN113110455B (zh) 一种未知初始状态的多机器人协同探索方法、装置及系统
CN114140761A (zh) 点云配准方法、装置、计算机设备和存储介质
CN114001733A (zh) 一种基于地图的一致性高效视觉惯性定位算法
EP3842836A1 (en) Method, apparatus and storage medium for positioning object
Zhao et al. Conic feature based simultaneous localization and mapping in open environment via 2D lidar
CN114111791B (zh) 一种智能机器人室内自主导航方法、系统及存储介质
CN117367412B (zh) 一种融合捆集调整的紧耦合激光惯导里程计与建图方法
CN113759364A (zh) 一种基于激光地图的毫米波雷达连续定位方法及装置
WO2022021661A1 (zh) 一种基于高斯过程的视觉定位方法、系统及存储介质
CN114047766B (zh) 面向室内外场景长期应用的移动机器人数据采集系统及方法
CN115164887A (zh) 基于激光雷达与惯性组合的行人导航定位方法和装置
WO2023164933A1 (zh) 一种建筑物建模方法以及相关装置
CN113379915A (zh) 一种基于点云融合的行车场景构建方法
Escourrou et al. Ndt localization with 2d vector maps and filtered lidar scans
CN113758491B (zh) 基于多传感器融合无人车的相对定位方法、系统及车辆
Dai et al. Improved Grid-Based Rao-Blackwellized Particle Filter SLAM Based on Grey Wolf Optimizer
CN117191005B (zh) 一种空地异构协同建图方法、装置、设备及存储介质
CN112016640B (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
RJ01 Rejection of invention patent application after publication
RJ01 Rejection of invention patent application after publication

Application publication date: 20210730