return transformation matrix from registration.icp, make max_iter optional
unit test for ICP