Update KDTree.cs