Still modifying code to reuse code from RANSAC and DLT in reconstruction.