BFS_Maze_求解迷宫最短路径

/*
10 10
#.######.#
......#..#
.#.##.##.#
.#........
##.##.####
....#....#
.#######.#
....#.....
.####.###.
....#....#
0 1
9 8
*/
#define _CRT_SECURE_NO_WARNINGS
/*
10 10
#.######.#
......#..#
.#.##.##.#
.#........
##.##.####
....#....#
.#######.#
....#.....
.####.###.
....#....#
0 1
9 8
*/
#include <iostream>
#include <utility>
#include <queue>
using namespace std;

const int INF = 100000000;
const int MAX_N = 50, MAX_M = 50;

typedef pair<int, int> P;
//输入
char maze[MAX_N][MAX_M];
int N, M;
int sx, sy;
int gx, gy;
//到各个位置最短距离的数组
int d[MAX_N][MAX_M];

//4个方向移动的向量--下，右，上，左
int dx[4] = { 1, 0, -1, 0 }, dy[4] = { 0, 1, 0, -1 };

//从(sx, sy) 到 (gx, gy)的最短距离
int bfs()
{
    queue<P> que;
    for (int i = 0; i < N; i++)                   //未走过的都为INF 
    for (int j = 0; j < M; j++) d[i][j] = INF;
    //将起点加入队列, 并把这一地点的距离设置为0
    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++) {
            //移动之后的位置为 (nx, ny)
            int nx = p.first + dx[i], ny = p.second + dy[i];  //当前位置+方向 

            //判断是否可以移动以及是否已经访问过 (d[nx][ny] != INF 则已经访问过)
            if (0 <= nx && nx < N && 0 <= ny && ny < M && maze[nx][ny] != '#' && d[nx][ny] == INF) {
                que.push(P(nx, ny));          //将没有走过的路，入队
                //可以移动的话，则加入到队列，并且到该位置的距离确定为到p的距离+1 
                d[nx][ny] = d[p.first][p.second] + 1;
            }
        }
    }
    return d[gx][gy];
}

void solve()
{
    int res = bfs();
    printf("%d
", res);
}

void Input()
{
    cout << "设置Maze大小: 
";
    cin >> N >> M;
    cout << "设置迷宫(通路为 '.', 墙为'#'):
";
    for (int i = 0; i < N; i++) {
        for (int j = 0; j < M; j++)
            cin >> maze[i][j];
    }
    cout << "设置入口: (sx, sy): ";
    cin >> sx >> sy;
    cout << "设置出口: (gx, gy): ";
    cin >> gx >> gy;
}

int main(int argc, char const *argv[])
{
    Input();
    solve();
    return 0;
}