A New Approach to 3D ICP Covariance Estimation for Mobile Robotics

09/12/2019
by   Martin Brossard, et al.
0

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 ICP covariance computation that accounts for all the sources of errors as listed in Censi's pioneering work, namely wrong convergence, underconstrained situations, and sensor noise. Our approach builds on two facts. First, ICP is not a standard sensor: owing to wrong convergence the concept of ICP covariance per se is actually meaningless, as the dispersion in the ICP outputs may largely depend on the accuracy of the initialization, and is thus inherently related to the prior uncertainty on the displacement. We capture this using the unscented transform, which also reflects correlations between initial and final uncertainties. Then, assuming white sensor noise leads to overoptimism: 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 very favorably to previous methods. We finally demonstrate the benefits of our method for pose-graph localization, where our approach improves accuracy and robustness of the estimates.

READ FULL TEXT
research
10/02/2018

CELLO-3D: Estimating the Covariance of ICP in the Real World

The fusion of Iterative Closest Point (ICP) reg- istrations in existing ...
research
04/16/2020

Estimating Motion Uncertainty with Bayesian ICP

Accurate uncertainty estimation associated with the pose transformation ...
research
02/23/2022

Deep Bayesian ICP Covariance Estimation

Covariance estimation for the Iterative Closest Point (ICP) point cloud ...
research
06/07/2021

Stein ICP for Uncertainty Estimation in Point Cloud Matching

Quantification of uncertainty in point cloud matching is critical in man...
research
10/16/2014

On the Covariance of ICP-based Scan-matching Techniques

This paper considers the problem of estimating the covariance of roto-tr...
research
07/29/2022

Enhanced Laser-Scan Matching with Online Error Estimation for Highway and Tunnel Driving

Lidar data can be used to generate point clouds for the navigation of au...
research
12/10/2022

An approach to robust ICP initialization

In this note, we propose an approach to initialize the Iterative Closest...

Please sign up or login with your details

Forgot password? Click here to reset