Changes for optimizing closestPoint on pointCloud