KdTree: Updating the kdTree and PointSetVisualizer