BFS:迷宫的最短路径

时间:2022-02-18 18:58:15

宽度优先搜索思想:

宽度优先搜索总是先搜索目前距离初始状态最近的状态。对于同一个状态,宽度优先搜索只经过一次

问题重述:

给定一个大小为N*M的迷宫。迷宫由通道和墙壁组成,每一步都可以向相邻的上下左右四格的通道移动。请求出从起点到终点所需的最小步数。请注意,本题假定从起点一定可以移动到终点。

代码:

<span style="font-size:18px;">#include<cstdio>
#include<queue>
#include<utility>
#define MAX_N 128
#define MAX_M 128
const int INF=100000000;
typedef pair<int,int> P;
int maze[MAX_N][MAX_M];
int N,M;
int sx,sy; //起点坐标
int gx,gy; //终点坐标
int d[MAX_N][MAX_M];
int dx[4]={1,0,-1,0},dy[4]={0,1,0,-1};
//求从(sx,sy)到(gx,gy)的最短距离,如果无法到达,则是INF;
int bfs()
{
queue<P> que;
for(int i=0;i<N;i++)
for(int j=0;j<M;j++)
d[i][j]=INF;
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++)
{
int nx=p.first+dx[i],ny=p.second+dy[i];
if(nx>=0 &&nx<N && ny>=0 && ny<M && maze[nx][ny]!="#" && d[nx][ny]==INF)
{
que.push(P(nx,ny));
d[nx][ny]=d[p.first][p.second]+1;
}
}
}
return d[gx][gy];
}
void main()
{
scanf("%d%d",&N,&M);
scanf("%d%d",&sx,&sy);
scanf("%d%d",&gx,&gy);
int ans=bfs();
printf("%d",ans);
}</span>