Forgot to rebuild kdtree when adding addDataPoints called.