Robotics: Science and Systems XV

Systematic Handling of Heterogeneous Geometric Primitives in Graph-SLAM Optimization

Irvin Aloise, Bartolomeo Della Corte, Federico Nardi, Giorgio Grisetti


In this paper, we propose a pose-landmark graph optimization back-end that supports maps consisting of points, lines or planes. Our back-end allows representing both homogeneous (point-point, line-line, plane-plane) and heterogeneous measurements (point-on-line, point-on-plane, line-on-plane). Rather than treating all cases independently, we use a unified formulation that leads to both a compact derivation and a concise implementation. The additional geometric information, deriving from the use of higher-dimension primitives and constraints, yields to increased robustness and widens the convergence basin of our method. We evaluate the proposed formulation both on synthetic and raw data. Finally, we made available an open-source implementation to replicate the experiments.



    AUTHOR    = {Irvin Aloise AND Bartolomeo Della Corte AND Federico Nardi AND Giorgio Grisetti}, 
    TITLE     = {Systematic Handling of Heterogeneous Geometric Primitives in Graph-SLAM Optimization}, 
    BOOKTITLE = {Proceedings of Robotics: Science and Systems}, 
    YEAR      = {2019}, 
    ADDRESS   = {FreiburgimBreisgau, Germany}, 
    MONTH     = {June}, 
    DOI       = {10.15607/RSS.2019.XV.084}