Optimal Pose Estimation and Covariance Analysis with Simultaneous Localization and Mapping Applications

10/21/2022
by   Saeed Maleki, et al.
0

This work provides a theoretical analysis for optimally solving the pose estimation problem using total least squares for vector observations from landmark features, which is central to applications involving simultaneous localization and mapping. First, the optimization process is formulated with observation vectors extracted from point-cloud features. Then, error-covariance expressions are derived. The attitude and position estimates obtained via the derived optimization process are proven to reach the bounds defined by the Cramér-Rao lower bound under the small-angle approximation of attitude errors. A fully populated observation noise-covariance matrix is assumed as the weight in the cost function to cover the most general case of the sensor uncertainty. This includes more generic correlations in the errors than previous cases involving an isotropic noise assumption. The proposed solution is verified using Monte Carlo simulations and an experiment with an actual LIDAR to validate the error-covariance analysis.

READ FULL TEXT

page 26

page 27

page 30

page 31

page 32

research
06/22/2021

Total Least Squares for Optimal Pose Estimation

This work provides a theoretical framework for the pose estimation probl...
research
10/21/2022

Error-Covariance Analysis of Monocular Pose Estimation Using Total Least Squares

This study presents a theoretical structure for the monocular pose estim...
research
10/14/2021

Active SLAM over Continuous Trajectory and Control: A Covariance-Feedback Approach

This paper proposes a novel active Simultaneous Localization and Mapping...
research
08/25/2022

Lidar SLAM for Autonomous Driving Vehicles

This paper presents Lidar-based Simultaneous Localization and Mapping (S...
research
01/22/2022

Phase-SLAM: Phase Based Simultaneous Localization and Mapping for Mobile Structured Light Illumination Systems

Structured Light Illumination (SLI) systems have been used for reliable ...
research
11/15/2021

Observation Contribution Theory for Pose Estimation Accuracy

The improvement of pose estimation accuracy is currently the fundamental...
research
07/18/2023

Unbiased centroiding of point targets close to the Cramer Rao limit

This paper focuses on the achievable accuracy of center-of-gravity (CoG)...

Please sign up or login with your details

Forgot password? Click here to reset