4-points congruent sets for robust pairwise surface registration
Closed-form solution of absolute orientation using unit quaternions