Graph optimization with unstructured covariance: fast, accurate, linear approximation

  • Authors:
  • Luca Carlone;Jingchun Yin;Stefano Rosa;Zehui Yuan

  • Affiliations:
  • Dipartimento di Automatica e Informatica, Politecnico di Torino, Italy;Dipartimento di Automatica e Informatica, Politecnico di Torino, Italy;Italian Institute of Technology (IIT), Torino, Italy;Dipartimento di Automatica e Informatica, Politecnico di Torino, Italy

  • Venue:
  • SIMPAR'12 Proceedings of the Third international conference on Simulation, Modeling, and Programming for Autonomous Robots
  • Year:
  • 2012

Quantified Score

Hi-index 0.00

Visualization

Abstract

This manuscript addresses the problem of optimization- based Simultaneous Localization and Mapping (SLAM), which is of concern when a robot, traveling in an unknown environment, has to build a world model, exploiting sensor measurements. Although the optimization problem underlying SLAM is nonlinear and nonconvex, related work showed that it is possible to compute an accurate linear approximation of the optimal solution for the case in which measurement covariance matrices have a block diagonal structure. In this paper we relax this hypothesis on the structure of measurement covariance and we propose a linear approximation that can deal with the general unstructured case. After presenting our theoretical derivation, we report an experimental evaluation of the proposed technique. The outcome confirms that the technique has remarkable advantages over state-of-the-art approaches and it is a promising solution for large-scale mapping.