EllipsodidFactor: refactor first contact-point finding method