参考文献：
实现代码：https://gitee.com/upcgyl/astar.git
存在问题：
- 地图目前必须是可搜索到路径
- 周围点寻找太过复杂
- OpenList和CloseList结构不统一导致查找函数需要写两个
后续优化：
- 参考 ROS package of A star algorithm 中对周围节点的查询方式进行优化
- 思考二叉堆的实现方式
- 优化地图输入
- 区分linux端：增加OpenCV的地图识别，将邻接矩阵输入变为pgm地图输入
C++下的AStar实现
X
参考文献：
实现代码：https://gitee.com/upcgyl/astar.git
存在问题：
后续优化：
