Robust euclidean alignment of 3D point sets: the trimmed iterative closest point algorithm
Efficient variants of the ICP algorithm