Consensus set maximization with guaranteed global optimality for robust geometry estimation