图像广搜之队列BFS

迷宫问题加强版–BFS

这次采用队列搜索，因为没用过…

给定NxM的迷宫，1是墙，0是路，求起点到终点的最短距离并输出一条路线先后走过的路的坐标，如果无法到达，则输出QAQ

#include <bits/stdc++.h>

using namespace std;
int a[105][105];
int vis[105][105];
int nowi,nowj;
int toi,toj;
int fxx[5]= {0,0,0,1,-1};
int fxy[5]= {0,1,-1,0,0};
void bfs();
struct zb
{
    int x;
    int y;
};
queue<zb>que;
int flag=1;
void f_read();
struct zb read[1000];
int main()
{
    memset(a,0,sizeof(a));
    memset(vis,0,sizeof(vis));
    int n,m;
    flag=1;
    cin >> n >> m;
    for(int i=0; i<=n+1; i++)//设置边界
    {
        for(int j=0; j<=m+1; j++)
        {
            if(i==0||i==n+1||j==0||j==m+1)
            {
                vis[i][j]=-1;
            }
        }
    }
    for(int i=1; i<=n; i++)//画迷宫
    {
        for(int j=1; j<=m; j++)
        {
            cin >> a[i][j];
        }
    }
    cin >> nowi >> nowj;
    cin >> toi >> toj ;
    que.push({nowi,nowj});
    vis[nowi][nowj]=1;
    bfs();//广搜
    if(flag==0)
    {
        cout << "QAQ" << endl ;
        goto loop;
    }
    f_read();//搜索先后路线
    cout << vis[toi][toj] << endl ;
    for(int i=1;i<=vis[toi][toj];i++)
    {
        cout << read[i].x << " " << read[i].y << endl ;
    }
    loop:
    return 0;
}
void bfs()
{
    while(!que.empty())
    {
        struct zb save;
        save=que.front();
        if(save.x==toi&&save.y==toj)
            break;
        que.pop();
        for(int i=1; i<=4; i++)
        {
            if(a[save.x+fxx[i]][save.y+fxy[i]]==0&&vis[save.x+fxx[i]][save.y+fxy[i]]==0)
            {
                que.push({save.x+fxx[i],save.y+fxy[i]});
                vis[save.x+fxx[i]][save.y+fxy[i]]=vis[save.x][save.y]+1;
            }
        }
    }
    if(que.empty())
        flag=0;
}
void f_read()
{
    int x=toi;
    int y=toj;
    read[vis[toi][toj]]={x,y};
    flag=vis[toi][toj];
    while((x!=nowi)||(y!=nowj))
    {
        for(int i=1;i<=4;i++)
        {
            if(vis[x+fxx[i]][y+fxy[i]]+1==vis[x][y])
            {
                x=x+fxx[i];
                y=y+fxy[i];
                read[--flag]={x,y};
                break;
            }
        }
    }
}