Move iteration into trifocal calculation for RANSAC