建立拓扑地图，实现A*算法、深度优先和广度优先算法、Dijkstra算法路径规划-A topology map, achieving A* algorithm, depth first and breadth-first algorithm, Dijkstra algorithm for path planning