Robust 3D SLAM with a stereo camera based on an edge-point ICP algorithm
A method for registration of 3d shapes