Final Improvement on the KDTree.