In mobile robotics, scan matching of point clouds using Iterative Closest Point (ICP) allows estimating sensor displacements. It may prove important to assess the associated uncertainty about the obtained rigid transformation, especially for sensor fusion purposes. In this paper we propose a novel approach to 3D uncertainty of ICP that accounts for all the sources of error as listed in Censi's pioneering work [1], namely wrong convergence, underconstrained situations, and sensor noise. Our approach builds on two facts. First, the uncertainty about the ICP's output fully depends on the initialization accuracy. Thus speaking of the covariance of ICP makes sense only in relation to the initialization uncertainty, which generally stems from odometry errors. We capture this using the unscented transform, which also reflects correlations between initial and final uncertainties. Then, assuming white sensor noise leads to overoptimism as ICP is biased owing to e.g. calibration biases, which we account for. Our solution is tested on publicly available real data ranging from structured to unstructured environments, where our algorithm predicts consistent results with actual uncertainty, and compares favorably to previous methods.
SVN-ICP: Uncertainty Estimation of ICP-based LiDAR Odometry using Stein Variational Newton
Learning & Intelligent Systems Research Lab, TU Berlin(学习与智能系统研究实验室,柏林技术大学);Technical University of Munich(慕尼黑技术大学);Munich Institute of Robotics and Machine Intelligence (MIRMI)(慕尼黑机器人与机器智能研究所(MIRMI))
本文提出 SVN-ICP 算法,利用 Stein Variational Newton 在流形上实现基于 ICP 的激光雷达里程计不确定性估计,无需显式噪声建模,在多传感器融合中提供准确位姿估计和可靠不确定性。
Towards Robust LiDAR Localization: Deep Learning-based Uncertainty Estimation
Department of Computer Engineering, Amirkabir University of Technology(阿姆irkabir技术大学计算机工程系);Graduate School of Information Science and Technology, The University of Tokyo(东京大学信息科学与技术研究生院)
P3-LOAM: PPP/LiDAR Loosely Coupled SLAM with Accurate Covariance Estimation and Robust RAIM in Urban Canyon Environment
Shanghai Jiao Tong University(上海交通大学)
基于激光雷达(LiDAR)的同时定位与地图构建(SLAM)技术在自动驾驶领域引起了越来越多的关注。然而,LiDAR-SLAM遭受累积误差,这可以通过全球导航卫星系统(GNSS)显著减轻。精密单点定位(PPP)是一种不依赖于基站的高精度GNSS工作模式,在无人系统中越来越受欢迎。针对LiDAR-SLAM和PPP这两种技术的特点,提出了一种将LiDAR-SLAM和PPP相结合的SLAM系统P3-LOAM(PPP based LiDAR Odometry and Mapping)。为了更好地集成,我们通过使用奇异值分解(SVD)雅可比模型推导LiDAR-SLAM定位协方差,因为SVD提供了迭代最近点(ICP)的显式解析解,这是LiDAR-SLAM中的关键问题。然后提出了一种新的方法来评估估计的LiDAR-SLAM协方差。此外,为了提高GNSS在城市峡谷环境中的可靠性,我们开发了一种LiDAR-SLAM辅助GNSS接收机自主完整性监测(RAIM)算法。最后,我们验证P $^3$ -LOAM与UrbanNav,一个具有挑战性的公共数据集在城市峡谷环境。综合测试结果表明,P3-LOAM在精度和可用性方面优于单点定位(SPP)、PPP、LeGO-LOAM、SPP-LOAM以及UrbanNav出版商提出的松耦合导航系统等基准。
An Adaptive ICP LiDAR Odometry Based on Reliable Initial Pose
School of Information Science and Engineering, Wuhan University of Science and Technology(信息科学与工程学院,武汉科技大学);School of Computer Science and Technology, Wuhan University of Science and Technology(计算机科学与技术学院,武汉科技大学);School of Information Management and Institute of Big Data and Digital Economy, Hubei University of Economics(信息管理学院和大数据与数字经济研究院,湖北经济学院)