Iterative-Closest-Point--ICP- Writing a custom function to implement the ICP algorithm. This is the point cloud before ICP (Original and coloured to denote Source and Destination clouds) This is the point cloud after ICP