debugged kd tree, added benchmarking boilerplate, debugged kd tree