2.1.5.1迷宫的最短路径

问题描述:

给定一个大小为N×M的迷宫。迷宫由通道和墙壁组成,每一步可以向邻接的上下左右四格的通道移动。请求出从起点到终点所需的最小步数。请注意,本题假定从起点一定可以移动到终点。

限制条件:

N,M<=100

样例见教材P34

#include<stdio.h>
#include<queue>

const int INF = 100000000;
const int MAX_N = 100;
const int MAX_M = 100;

//使用pair表示状态时,使用typedef会更加方便一些
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];                //到各个位置最短距离的数组

//4个方向移动的向量
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(int i = 0;i < N;i++){
        for(int j = 0;j < M;j++){
            d[i][j] = INF;
        }
    }
    //将起点加入队列,并将这一地点的距离设置为0
    que.push(P(sx,sy));
    d[sx][sy] = 0;

    //不断循环知道队列的长度为0
    while(!queue.empty()){
        //从队列的最前端取出元素
        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){
                //可以移动的话则加入到队列,并且到该位置的距离设置为到p的距离+1
                que.push(P(sx,sy));
                d[nx][ny] = d[p.first][p.second] + 1;
            }
        }
    }
    return d[gx][gy];
}

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



猜你喜欢

转载自blog.csdn.net/qq_38943651/article/details/79104340