Robust 3D SLAM with a stereo camera based on an edge-point ICP algorithm
Good features to track