Least-squares-fitting-of-two-3-D-point-sets-IEEE-T-Pattern-Anal