Trying out an ICP implementation from PCL's documentation