Tools for 3D point cloud registration