nd-icp is a generic n dimensional implementation of the ICP algorithm based on SVD and the nalgebra linear algebra library
nd-icp