初级BFS

#include<iostream>
#include<stdio.h>
#include<cstring>
#include<queue>
using namespace std;
#define INF 10000000
typedef pair<int,int>P;
char mp[106][107];
int n,m;
int sx,sy;
int gx,gy;
int d[106][107];
int dx[4]={1,0,-1,0},dy[4]={0,1,0,-1};
int BFS()
{
    queue<P>que;
    for(int i=0;i<m;i++)
        for(int j=0;j<n;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];
            int ny=p.second+dy[i];
            if(0<=nx&&nx<m&&0<=ny&&ny<n&&mp[nx][ny]!='#'&&d[nx][ny]==INF)
            {
                que.push(P(nx,ny));
                d[nx][ny]=d[p.first][p.second]+1;
            }
        }
    }
    return d[gx][gy];
}
int main()
{
    int i,j;
     cin>>m>>n;
        getchar();
        for(i=0;i<m;i++)
        {

            for(j=0;j<n;j++)
        {
            scanf("%c",&mp[i][j]);
            if(mp[i][j]=='S'){sx=i;sy=j;}
            if(mp[i][j]=='G'){gx=i;gy=j;}
        }
                    getchar();
        }
     int res=BFS();
     cout<<res<<endl;
     return 0;
}

求迷宫最短路