SFM: Added code to obtain optimal rotation matrix
SFM: Fixed initial pair component, small RANSAC changes