Robust map optimization using dynamic covariance scaling
Hierarchical optimization on manifolds for online 2D and 3D mapping