added ICP, moved all static functions in PointCloudManipulation to namespace