KDTree.query_subset should now always return a result