New Ransac implementation WORKING