Partial Hierarchical Pose Graph Optimization for SLAM

Alexander Korovko, Dmitry Robustov

In this paper we consider a hierarchical pose graph optimization (HPGO) for Simultaneous Localization and Mapping (SLAM). We propose a fast incremental procedure for building hiera…