python寻找地图上最短路线_python游戏地图最短路径求解

一．题目要求

参考下图完成游戏地图中从起点到目标点的最短路径寻找问题。

二．设计思路

先对游戏地图做了几个设定，以矩阵来模拟游戏地图。将可行的区域位置赋值0，障碍区赋值为inf。考虑到地图大小，将起始点和终点区域赋值99。

从Start点A开始向外层扩展，每扩展一层pathlen加一。List Q存储当前需要扩展的点，list P 存储当前扩展层。当扩展到End点B时扩展结束，路径可规划。当Q为空时，本次层扩展结束，检查P，若P非空，从P层向外扩展，若P为空，则End点B无法到达。

寻找最短路径时，从End点B开始，寻找当前点附近8个点的标记中比当前点标记小的点，直到标记为1为止。

三．程序主体

# -*-coding:gbk -*-

from numpy import *

dirs = [(1,1),(1,0),(1,-1),(0,-1),(-1,-1),(-1,0),(-1,1),(0,1)] # 四邻位置：从右下角开始顺时针得到，是按坐标差得到的

def find_path(oldmap,A,B):

oldmap[A[0], A[1]] = 99

oldmap[B[0], B[1]] = 99

[a,b]=oldmap.shape

pathmap=oldmap.copy()

Q=[]#存储扩展节点

P=[]#往外一层

pathlen=1

if A