广度优先搜索BFS

广度优先搜索

假如我们走一个迷宫，深度优先搜索是走到遇到障碍物再回溯，而广度优先搜索是一次走完一步的所有地方——也就是走每一步时，走完这一步里可以走的所有地方。
具体思想

void bfs(Vertex v)//从v这个顶点开始遍历
{
    visited[V]=true;//确认v
    inqueue(V,queue);//把v放入队列中
    while(!isEmpty)
    {
        V=Dequeue(queue);//将队列中的弹出
        for(v的每一个相邻接点i)
        {
            if(!visited[i])
            {
                visited[i]=true;
                inqueue(V,queue);//把v放入队列中
            }
        }
    }
}

第一行又两个数n，m。n表示迷宫的行，m表示迷宫的列，接下来是一个n行m列的迷宫，0表示空地，1表示障碍物，最后一行四个数前两个数表示为迷宫入口的x和y坐标，后两个为迷宫出口的x和y坐标
代码如下：

#include<stdio.h>
#include<string.h>
#include<stdlib.h>
struct node
{
    int x;//横坐标
    int y;//纵坐标
    int f;//该点的父亲在队列中的编号
    int s;//步数
};
int main()
{
    int n,m;
    while(~scanf("%d%d",&n,&m))
    {
        int i,j,k;
        struct node queue[100];
        int a[30][30]={0};
        int book[30][30]={0};//表示走的方向的数组
        int startx,starty,endx,endy;//表示迷宫的入口和出口
        int flag,tx,ty;
        for(i=1;i<=n;i++)
        {
            for(j=1;j<=m;j++)
            {
                scanf("%d",&a[i][j]);
            }
        }
        scanf("%d%d%d%d",&startx,&starty,&endx,&endy);
        int next[4][2]={{0,1},{1,0},{0,-1},{-1,0}};
        int head=1,tail=1;
        queue[tail].x=startx;
        queue[tail].y=starty;
        queue[tail].f=0;
        queue[tail].s=0;
        tail++;
        book[startx][starty]=1;
        flag=0;//用来标记是否达到目标点，0表示暂时还没有到达，1表示到达
        while(head<tail)
        {
            for(k=0;k<=3;k++)
            {
                tx=queue[head].x+next[k][0];
                ty=queue[head].y+next[k][1];//计算下一个坐标
                if(tx<1||tx>n||ty<1||ty>m)//判断是否越界
                {
                    continue;//判断是否是障碍物或者已经在路径中
                }
                if(a[tx][ty]==0&&book[tx][ty]==0)
                {
                    book[tx][ty]=1;//把这个点标为走过
                    queue[tail].x=tx;//将新的点插入队列中
                    queue[tail].y=ty;
                    queue[tail].f=head;//因为这个点是从head扩展出来的
                    queue[tail].s=queue[head].s+1;//步数是父亲步数+1
                    tail++;
                }
                if(tx==endx&&ty==endy)//到达终点，结束
                {
                    flag=1;
                    break;
                }
            }
            if(flag==1)
                break;
            head++;
        }
        printf("%d\n",queue[tail-1].s);
    }
    return 0;
}