BFS求迷宫的最短路径

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

const int INF = 10000000;

typedef pair<int, int> P;//保存状态，即点的位置

//迷宫，'#'表示墙壁， '.'表示通道，S表示起点，G表示终点
char maze[10][10] = 
{
    '#','S','#','#','#','#','#','#','.','#',
    '.','.','.','.','.','.','.','#','.','#',
    '.','#','.','#','#','.','#','#','.','#',
    '.','#','.','.','.','.','.','.','.','.',
    '#','#','.','#','#','.','#','#','#','#',
    '.','.','.','.','#','.','.','.','.','#',
    '.','#','#','#','#','#','#','#','.','#',
    '.','.','.','.','#','.','.','.','.','.',
    '.','#','#','#','#','.','#','#','#','.',
    '.','.','.','.','#','.','.','.','G','#'
};
const int N  = 10;
const int M = 10;
int sx = 0, sy = 1; //起点
int gx = 9, gy = 8; //终点
int d[N][M];    //到各点的最短距离数组
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;  //起点距离为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 (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];
}

int main()
{
    cout << "最短距离：" << bfs() << endl;
    getchar();
    return 0;
}