BFS_迷宫问题输出最短路径（在原地图中输出路径）

问题描述

代码：

#include
using namespace std;

const int maxn = 1010;
char mp[maxn][maxn];//存放地图
int dist[maxn][maxn];//距离矩阵   记录各个点到终点的最短路长度
int vis[maxn][maxn];//记录顺序
int n,m;
int sx, sy, tx, ty;//记录起止点的横纵坐标
int dx[4] = {1, 0, 0, -1}, dy[4] = {0, -1, 1, 0};//用来方便往四个方向走
void bfs()
{
    for(int i = 0; i < n; i ++) //将dist数组初始化为无穷大
        for(int j = 0; j < n; j ++)
            dist[i][j] =-2;
    dist[tx][ty] = 0;//终点到终点距离为零
    queue > q;//bfs用队列实现，这里用pair记录点的横纵坐标，当然用结构体实现也是可以的
    pair t;//临时用的
    t.first = tx;
    t.second = ty; //用t记录终点
    q.push(t);//终点入队
    while(q.size()){
        t = q.front();//每次取出队头元素
        q.pop();//队头元素出队
        for(int i = 0; i < 4; i ++){//遍历队头元素可以往哪走
            int nx = t.first + dx[i];
            int ny = t.second + dy[i];//这两句话实现了往一个方向走，想不明白可以在纸上画一下
            if(nx >= 0 && nx < n && ny >= 0 && ny < n && dist[nx][ny] ==-2 && mp[nx][ny] != 'X'){
                //条件的作用分别是：判断是否越界；判断是否走过（如果走过了，dist的值一定被改变了）；判断是否可走（障碍物则此路不通）
                dist[nx][ny] = dist[t.first][t.second] + 1;//满足条件则为上一个点多走一步，离终点的距离也就多1
                q.push(make_pair(nx, ny));//将该点入队，方便下次从该点出发遍历
            }
        }
    }
}

int main()
{
    cin >>m>>n;
    //初始化vis为-132方便标记
    for(int i=0;i> mp[i][j];
            if(mp[i][j] == 'S'){
                sx = i;
                sy = j;
            }
            if(mp[i][j] == 'E'){
                tx = i;
                ty = j;
            }
        }
    }

    bfs();//开始搜索

    cout << dist[sx][sy] << endl;//起点到终点的最短路长度
    int x = sx, y = sy;
    vis[x][y]=0;
    int sum=1;
    cout<<"输出步骤\n";
    cout << "(" << x << ", " << y << ")" << endl;
    while(x != tx || y != ty){
        for(int i = 0; i < 4; i ++){
            int nx = x + dx[i];
            int ny = y + dy[i];
            if(nx >= 0 && nx < n && ny >= 0 && ny < n && mp[nx][ny] !='X'){
                if(dist[x][y] == dist[nx][ny] + 1){
                    cout << "(" << nx << ", " << ny << ")" << endl;
                    vis[nx][ny]=sum++;
                    x = nx;
                    y = ny; //更新x ,y
                    break;
                }

            }
        }
    }
    cout<<"在原地图中输出路线\n";
    for(int i = 0; i < m; i ++){     //输入图并记录起止点的坐标
        for(int j = 0; j < n; j ++){
            //printf("%c ",mp[i][j]);
            if(vis[i][j]==-132)
            {
                printf("%c ",mp[i][j]);
            }
            else
            {
                printf("%d ",vis[i][j]);
            }
        }
        cout<