迷宫的最短路径 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;
}