如果有写 K-D Tree 优化建图被卡常的，参考以下几个优化：
1、可以把 K-D Tree 的查询操作用队列改为非递归式的。
2、用指针实现 K-D Tree。
3、用指针写链式前向星。
4、fread。
