Hierarchical optimization on manifolds for online 2D and 3D mapping
Graphical SLAM - a self-correcting map