ICP-based pose-graph SLAM
A method for registration of 3d shapes