real - time 3 d visual slam with a hand - held rgb - d camera .
Hierarchical optimization on manifolds for online 2D and 3D mapping