Robust iterative closest point algorithm for registration of point sets with outliers
Least-Squares Fitting of Two 3-D Point Sets