SFM: Work on pose and RANSAC