用BFS解决一个基础的迷宫问题

题目描述

样例输入

10 10
#S######.#
......#..#
.#.##.##.#
.#........
##.##.####
....#....#
.#######.#
....#.....
.####.###.
....#...G#

样例输出

22

代码

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

const int INF = 100000000;//定义一个大数，每个坐标只会访问一次
const int max_m = 100,max_n = 100;
typedef pair<int,int>P;//定义一个坐标格式，让队列可以储存坐标
int N,M;
int sx,sy,gx,gy,i,j;//起点终点坐标
char f[max_n+1][max_m+1];//迷宫
int d[max_n+1][max_m+1];//储存到各个位置最短距离的数组
int dx[4] = {1,0,-1,0},dy[4] = {0,1,0,-1};//上下左右四个方向

//求从（sx,sy）到（gx,gy)的最短距离
//如果无法到达，则是INF
int bfs()
{
    queue<P>que;//队列储存坐标
	//把所有的位置都初始化为INF
    for(i = 0;i<N;i++)
    {
        for(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(i = 0;i<4;i++)
        {
            //移动之后的位置记为（nx,ny）
            int nx = p.first+dx[i],ny = p.second+dy[i];
            //判断是否可以移动以及是否已经访问过（d[nx][ny]!=INF即为已访问过
            if(nx>=0&&nx<N&&ny>=0&&ny<M&&d[nx][ny]==INF&&f[nx][ny]!='#')
            {
                //可以移动的话，则加入到队列，并且到该位置的距离确定为到p的距离+1
                que.push(P(nx,ny));
                d[nx][ny] = d[p.first][p.second]+1;
            }
        }
    }
    return d[gx][gy];
}

int main()
{
    scanf("%d%d",&N,&M);
    for(i = 0;i<N;i++)
    {
        getchar();
        for(j = 0;j<M;j++)
        {
            scanf("%c",&f[i][j]);
            if(f[i][j]=='S')//找到起点和终点的坐标
                sx = i,sy = j;//没有使用大括号，必须中间是逗号，否则if语句的约束只到第一个分号处。
            if(f[i][j]=='G')
                gx = i,gy = j;
        }
    }
    int res = bfs();
    printf("%d\n",res);
    return 0;
}