kdtree模板,采用c++编写!