宽度优先遍历-迷宫的最短路径

迷宫的最短路径

输出：22

#include<bits/stdc++.h>
#define INF 10000000
using namespace std;
typedef pair<int,int> P;
char c[105][105];//表示迷宫的字符串的数组
int N,M;
int sx,sy;//起点坐标
int gx,gy;//终点坐标
int d[105][105];//到各个位置的最短距离的数组
int dx[4]={1,0,-1,0},dy[4]={0,1,0,-1};
//求从(sx,sy)到(gx,gy)的最短距离
//如果无法到达，则是INF
int bfs()
{
    queue<P> que;
//把所有的位置都初始化成INF
    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++){
        int nx=p.first+dx[i],ny=p.second+dy[i];
        if(nx>=0 && nx<N && ny>=0 && ny<M && c[nx][ny]!='#' && d[nx][ny] == INF){
            que.push(P(nx,ny));//判断是否可以移动以及是否访问过d[nx][ny]!=INF即为已经访问过
            可移动则加入队列，并且该位置的距离确定为到P的位置加一
            d[nx][ny] = d[p.first][p.second]+1;
        }
     }
}
    return d[gx][gy];
}
int main()
{
    scanf("%d%d",&N,&M);
    getchar();
    for(int i=0;i<N;i++){
        for(int j=0;j<M;j++){
            scanf("%c",&c[i][j]);
            if(c[i][j] == 'S'){
                sx=i;
                sy=j;
            }
            if(c[i][j] == 'G'){
                gx=i;
                gy=j;
            }
        }
        getchar();
    }
    int res=bfs();
    printf("%d\n",res);
    return 0;
}