A Comparison of Four Algorithms for Estimating 3-D Rigid Transformations
Least-Squares Fitting of Two 3-D Point Sets