Fast planar surface 3D SLAM using LIDAR
A method for registration of 3d shapes