Efficient variants of the ICP algorithm
Closed-form solution of absolute orientation using unit quaternions