迷宮的最短路徑 bfs

給定一個大小爲N*M的迷宮，由通道(‘.’)和牆壁(‘#’)組成，其中通道S表示起點，通道G表示終點，每一步移動可以達到上下左右中不是牆壁的位置。試求出起點到終點的最小步數。（本題假定迷宮是有解的）(N,M<=100)

樣例輸入：

10 10

樣例輸出：

22

#include<iostream>
#include<queue>
#include<utility>
using namespace std;

const int INF = 100000;
const int MAX_N = 100 ;
const int MAX_M = 100;
typedef pair<int ,int> P;
char maze[MAX_N][MAX_M+1];
int N,M;
int sx , sy ;
int gx ,gy ;

int d[MAX_N][MAX_M];

int dx[4] = {1 ,0,-1,0};
int dy[4] ={0 , 1 , 0 ,-1};

void 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();
        for(int i = 0 ; i<4 ; i++){
            int nx = p.first + dx[i];
            int ny = p.second+ dy[i];
            if(0 <= nx&&nx < N && 0 <= ny&&ny < M  &&maze[nx][ny] != '#' &&d[nx][ny] == INF){
                que.push(P(nx , ny));
                d[nx][ny] = d[p.first][p.second]+1;
                if(nx==gx && ny==gy) break;
            }
        }
    }
int main()  {
    cin>>N>>M;
    for (int i = 0; i < N; i++)
        cin>>maze[i];
    for (int i = 0; i < N; i++)
        for (int j = 0; j < M; j++){
            if (maze[i][j] == 'S'){
                sx = i; sy = j;
            }
            if (maze[i][j] == 'G'){
                gx = i; gy = j;
            }
        }
    bfs();
    cout<<d[gx][gy]<<endl;

    return 0;
}