Least squares fit

Find “average” translation vector for largest set of inliers