下面是一个简单的路径规划代码的示例,它使用了广度优先搜索算法来找出起点到终点的最短路径:
from collections import deque
def find_path(graph, start, end):
# 创建一个队列用于保存搜索状态
queue = deque([[start]])
# 创建一个列表用于保存已经访问过的节点
visited = []
# 当队列不为空时
while queue:
# 取出队列中的第一个元素
path = queue.popleft()
# 取出这个元素的最后一个节点