广度优先搜索BFS——模板（附四维拓展：SDUT 3929魔戒）

广度优先搜索使用队列(queue)来实现，整个过程也可以看做一个倒立的树形：

把根节点放到队列的末尾。每次从队列的头部取出一个元素，查看这个元素所有的下一级元素，把它们放到队列的末尾。并把这个元素记为它下一级元素的前驱。

找到所要找的元素时结束程序。

如果遍历整个树还没有找到，结束程序。

 一般用于求起点到终点的步数。

#include <stdio.h>
#include <string.h>
#include <queue>
using namespace std;
struct node
{
    int x,y,step;
};
char map[105][105];
int vis[105][105];
int to[4][2]= {1,0,-1,0,0,1,0,-1};
int n,m,sx,sy,ex,ey,ans;
int check(int x,int y)
{
    if(x<0 || x>=n || y<0 || y>=m)
        return 1;
    if(vis[x][y] || map[x][y]=='#')
        return 1;
    return 0;
}
 
void bfs()
{
    int i;
    queue<node> Q;
    node a,next;
    a.x = sx;
    a.y = sy;
    a.step = 0;
    vis[a.x][a.y]=1;
    Q.push(a);
    while(!Q.empty())
    {
        a = Q.front();
        Q.pop();
        if(map[a.x][a.y]=='E')
        {
            ans = a.step;
            return ;
        }
        for(i = 0; i<4; i++)
        {
            next = a;
            next.x+=to[i][0];
            next.y+=to[i][1];
            if(check(next.x,next.y))
                continue;
            next.step=a.step+1;
            vis[next.x][next.y] = 1;
            Q.push(next);
        }
    }
    ans = -1;
}
 
int main()
{
    int t;
    scanf("%d",&t);
    while(t--)
    {
        scanf("%d%d",&n,&m);
        int i,j;
        for(i = 0; i<n; i++)
            scanf("%s",map[i]);
        for(i = 0; i<n; i++)
        {
            for(j = 0; j<m; j++)
            {
                if(map[i][j]=='S')
                {
                    sx = i;
                    sy = j;
                }
            }
        }
        memset(vis,0,sizeof(vis));
        bfs();
        printf("%d\n",ans);
    }
    return 0;
}

模板适用于大部分题，包括下面这道四维坐标的，也是直接撸模板

Problem Description

蓝色空间号和万有引力号进入了四维水洼，发现了四维物体--魔戒。

这里我们把飞船和魔戒都抽象为四维空间中的一个点，分别标为 "S" 和 "E"。空间中可能存在障碍物，标为 "#"，其他为可以通过的位置。

现在他们想要尽快到达魔戒进行探索，你能帮他们算出最小时间是最少吗？我们认为飞船每秒只能沿某个坐标轴方向移动一个单位，且不能越出四维空间。

Input

输入数据有多组（数据组数不超过 30），到 EOF 结束。

每组输入 4 个数 x, y, z, w 代表四维空间的尺寸（1 <= x, y, z, w <= 30）。

接下来的空间地图输入按照 x, y, z, w 轴的顺序依次给出，你只要按照下面的坐标关系循环读入即可。

for 0, x-1

    for 0, y-1

        for 0, z-1

            for 0, w-1

保证 "S" 和 "E" 唯一。

Output

对于每组数据，输出一行，到达魔戒所需的最短时间。

如果无法到达，输出 "WTF"（不包括引号）。

Sample Input

2 2 2 2
..
.S
..
#.
#.
.E
.#
..
2 2 2 2
..
.S
#.
##
E.
.#
#.
..

Sample Output

1
3

ac代码如下：

#include <stdio.h>
#include <queue>
#include <string.h>
using namespace std;
int A,B,C,D;
char map[55][55][55][55];
int vis[55][55][55][55];
int dirx[]= {1,-1,0,0,0,0,0,0};
int diry[]= {0,0,1,-1,0,0,0,0};
int dirz[]= {0,0,0,0,1,-1,0,0};
int dirw[]= {0,0,0,0,0,0,1,-1};///飞船只能沿着坐标轴方向移动
int aa,bb,cc,dd;
struct node
{
    int x;///记录在四维空间中的位置
    int y;
    int z;
    int w;
    int step;///记录飞船移动的步数
};
int judge(int x,int y,int z,int w)///判断所在的位置是否合法，既要在四维空间内还要能走并且没有访问过
{
    if (x>=0&&x<A&&y>=0&&y<B&&z>=0&&z<C&&w>=0&&w<D)
    {
        if(vis[x][y][z][w]==0&&map[x][y][z][w]!='#')
        {
            return 1;
        }
    }
    return 0;
}
int bfs(int aa,int bb,int cc,int dd)
{
    queue<node>Q;
    int flag;
    node a;
    a.x=aa;
    a.y=bb;
    a.z=cc;
    a.w=dd;
    a.step=0;
    vis[aa][bb][cc][dd]=1;
    Q.push(a);
    flag=1;
    while (!Q.empty())
    {
        a=Q.front();
        if (map[a.x][a.y][a.z][a.w]=='E')
        {
            return a.step;
        }
        for (int i=0; i<8; i++)
        {
            node b;
            b=a;
            b.x+=dirx[i];
            b.y+=diry[i];
            b.z+=dirz[i];
            b.w+=dirw[i];
            if (judge(b.x,b.y,b.z,b.w))
            {
                b.step++;
                vis[b.x][b.y][b.z][b.w]=1;
                Q.push(b);
            }
        }
        Q.pop();
    }
   return -100;
}
int main ()
{
    int ans;
    while(scanf ("%d%d%d%d",&A,&B,&C,&D)!=EOF)
    {
        getchar();
        for (int i=0; i<A; i++)
        {
            for (int j=0; j<B; j++)
            {
                for (int k=0; k<C; k++)
                {
                    for(int l=0; l<D; l++)
                    {
                        scanf ("%c",&map[i][j][k][l]);
                        if (map[i][j][k][l]=='S')
                        {
                            aa=i;
                            bb=j;
                            cc=k;
                            dd=l;///记录下飞船在四维空间的起始位置
                        }
                    }
                    getchar();
                }
            }
        }
        memset(vis,0,sizeof(vis));
        ans=bfs(aa,bb,cc,dd);
        if (ans==-100)
        {
            printf ("WTF\n");
        }
        else
        {
            printf("%d\n",ans);
        }
    }
    return 0;
}