kd-tree 算法请教

[zhouzhou113]

https://blog.csdn.net/qing101hua/article/details/53228668

参考上述博客实现了一个四维的 kdtree，构建树并查找最近的一个点，遇到的问题是智能查找根节点的左子树或者右子树，如果第一次向下搜索到的叶子节点与实际的最近节点不在根节点的同一侧，如初始叶节点在左子树而实际结果在右子树，就没办法找到正确结果，尝试找到的疑似原因是搜索路径 search_path 不断向上搜索到根节点时会认为搜索完毕而没有跳转的另一边的子树。。

请教，有没有用过 kdtree 的大佬可以提供一个比较完善的 kdtree 算法的 C++实现？感激涕零