Incremental update to KTKDTree.hh