Modified registration to use keypoints from SLAM instead of computing SIFT3D