Major fixes to RANSAC, minor changes to TestTracking
RANSAC fixes