Hierarchical optimization on manifolds for online 2D and 3D mapping
Robust and Efficient Robotic Mapping