A statistical measure for map consistency in SLAM
Hierarchical optimization on manifolds for online 2D and 3D mapping