find shorttest path

最新推荐文章于 2025-11-16 14:28:09 发布

原创最新推荐文章于 2025-11-16 14:28:09 发布 · 788 阅读

0 ·

CC 4.0 BY-SA版权

数据结构与算法专栏收录该内容

213 篇文章

订阅专栏

本文介绍了一种求解迷宫最短路径的算法，通过深度优先搜索的方式，从起点'S'出发，寻找到达终点'E'的最短步数。算法避免了已访问的位置和障碍物，适用于由'O'（开放）、'X'（障碍物）、'S'（起点）、'E'（终点）组成的迷宫。

def find_shortest_path(maze):
    '''
    maze = [['X', 'X', 'O', 'S', 'X'],
              ['X', 'X', 'O', 'O', 'X'],
              ['X', 'X', 'O', 'X', 'X'],
              ['X', 'X', 'O', 'E', 'X']]'''
    a=[]
    b=[]
    s1=s2=e1=e2=0
    for i in range(len(maze)):
        for j in range(len(maze[0])):
            if maze[i][j]=='S':
                s1=i
                s2=j
            if maze[i][j]=='E':
                e1=i
                e2=j
    a.append([(s1,s2),])
    while len(a)>0:
        b=[]
        for aaa in a:
            #up
            aa=aaa[:]
            if aa[-1][0]-1>=0:
                if aa[-1][0]-1 == e1 and aa[-1][1] == e2:
                    return len(aa)
                if maze[aa[-1][0]-1][aa[-1][1]]=='O' and (aa[-1][0]-1,aa[-1][1]) not in aa:
                    aa.append((aa[-1][0] - 1, aa[-1][1]))
                    b.append(aa)
            #left
            aa=aaa[:]
            if aa[-1][1]-1>=0:
                if aa[-1][0]==e1 and  aa[-1][1]-1==e2:
                    return len(aa)
                if maze[aa[-1][0]][aa[-1][1]-1]=='O' and (aa[-1][0],aa[-1][1]-1) not in aa:
                    aa.append((aa[-1][0], aa[-1][1] - 1))
                    b.append(aa)
            #right
            aa=aaa[:]
            if aa[-1][1]+1<len(maze[0]):
                if aa[-1][0] == e1 and aa[-1][1] +1 == e2:
                    return len(aa)
                if maze[aa[-1][0]][aa[-1][1]+1]=='O' and (aa[-1][0],aa[-1][1]+1) not in aa:
                    aa.append((aa[-1][0], aa[-1][1] + 1))
                    b.append(aa)
            #down
            aa=aaa[:]
            if aa[-1][0]+1<len(maze):
                if aa[-1][0]+1==e1 and aa[-1][1]==e2:
                    return len(aa)
                if maze[aa[-1][0]+1][aa[-1][1]]=='O' and (aa[-1][0]+1,aa[-1][1]) not in aa:
                    aa.append((aa[-1][0] + 1, aa[-1][1]))
                    b.append(aa)
        a=b
    return -1
maze = [['X', 'O', 'O', 'O', 'X'],
         ['X', 'O', 'O', 'O', 'X'],
         ['X', 'O', 'O', 'O', 'O'],
        ['X', 'O', 'S', 'O', 'E']]
print find_shortest_path(maze)