迷宫的最短路径
输入一个NxM的迷宫。’#’,’.’,‘S’,'G’分别表示墙壁、通道、起点、终点。每一步可以向邻接的上下左右四个方向移动,求出从起点到终点所需的最小步数。(N,M<=100)
输入用例:
10 10
#S######.#
…#…#
.#.##.##.#
.#…
##.##.####
…#…#
.#######.#
…#…
.####.###.
…#…G#
输出:
22
思路:宽度优先搜索按照距离起点由近及远的顺序进行搜索,易求出最短路径。
#include<iostream>
#include<queue>
using namespace std;
const int INF = 100000000;
//存放坐标
typedef pair<int, int> P;
//存放迷宫
char maze[101][101];
//起点终点坐标;
int sx,sy;
int gx,gy;
//地图大小为nxm
int n,m;
//到各个点的距离
int d[101][101];
//上下左右移动的坐标增量
int dx[4]={0, 0, -1, 1},dy[4]={1, -1, 0, 0};
int bfs()
{
queue<P> que;
//初始化每个点的距离
for(int i=0;i<n;i++)
{
for(int j=0;j<m;j++)
d[i][j]=INF;
}
//将起点放入,并设其距离为0
que.push(P(sx,sy));
d[sx][sy]=0;
while(que.size())
{
P p=que.front();
que.pop();
//取出的状态是终点,退出
if(p.first==gx&&p.second==gy)
break;
//四个方向循环
for(int i=0;i<4;i++)
{
//移动后的位子为(nx,ny)
int nx = p.first + dx[i];
int ny = p.second + dy[i];
//判断是否可以移动以及是否已经访问过
if(0<=nx&&nx<n&&0<=ny&&ny<m&&d[nx][ny]==INF&&maze[nx][ny]!='#')
{
que.push(P(nx,ny));
d[nx][ny] = d[p.first][p.second] + 1;
}
}
}
return d[gx][gy];
}
int main()
{
cin>>n>>m;
for(int i=0;i<n;i++)
{
for(int j=0;j<m;j++)
{
cin>>maze[i][j];
if(maze[i][j]=='S')
{
sx=i;
sy=j;
}
else if(maze[i][j]=='G')
{
gx=i;
gy=j;
}
}
}
int mind = bfs();
cout<<mind<<endl;
}