Real-time loop closure in 2D LIDAR SLAM
branch and bound algorithms - principles and examples .