Consistent sparsification for graph optimization
Hierarchical optimization on manifolds for online 2D and 3D mapping