Added better testing for DynamicKdTree