kdtree search partially multithreaded

more test and profiling is needed