Iterative closes point - Registration 3D Geometry Processing