迷宫问题_BFS_挑战程序设计竞赛p34

给定一个N*M的迷宫，求从起点到终点的最小步数。

N,M<100；

输入：

10 10
#S######.#
......#..#
.#.##.##.#
.#........
##.##.####
....#....#
.#######.#
....#.....
.####.###.
....#...G#

输出：

22

：在求最短路时使用宽度优先搜索。

#include <iostream>
#include <cstdio>
#include <queue>

using namespace std;

const int INF=100000000;

typedef pair<int,int> P;

char maze[200][200];
int N,M;
int sx,sy;
int gx,gy;
int d[200][200];
int dx[4]={1,0,-1,0},dy[4]={0,1,0,-1};

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 solve(){
    int res=bfs();
    printf("%d
",res);
}

int main()
{
    while(~scanf("%d %d",&N,&M)){
        getchar();
        for(int i=0;i<N;i++){
            for(int j=0;j<M;j++){
                scanf("%c",&maze[i][j]);
                if(maze[i][j]=='S'){
                    sx=i;
                    sy=j;
                }
                if(maze[i][j]=='G'){
                    gx=i;
                    gy=j;
                }
            }
            getchar();
        }
        solve();
    }
    return 0;
}