解救人质 BFS模板(迷宫问题)

和上个DFS的问题一样,这次用BFS的思想,BFS没有像DFS那样专门有个step累加,是靠队列思想实现,更像一群路径竞速,最快的到达后,就break输出了

#include <stdio.h>

struct node
{
    int x;
    int y;
    int f;//父亲在队列中的编号,本题不要求输出路径,可以不需要f
    int s;//步数
};

int main()
{
        struct node que[2501];

        int a[51][51]={0};
        int book[51][51]={0};

        //定义一个用于表示走的方向的数组
        int next[4][2]={{0,1},{1,0},{0,-1},{-1,0}};
        int head,tail;
        int i,j,k,n,m,start_x,start_y,p,q,tx,ty,flag;
       scanf("%d %d",&n,&m);
       for(i=1;i<=n;i++)
        for(j=1;j<=m;j++)
        scanf("%d",&a[i][j]);
        scanf("%d %d %d %d",&start_x,&start_y,&p,&q);

        //队列初始化
        head=1;
        tail=1;

        //往队列插入迷宫入口坐标
        que[tail].x=start_x;
        que[tail].y=start_y;
        que[tail].f=0;
        que[tail].s=0;
        tail++;
        book[start_x][start_y]=1;

        flag=0;//用来标记是否到达目标点
        while(head<tail){  //向左的队伍,左边是头,右边是尾
                //枚举四个方向
                for(k=0;k<=3;k++){
                    //计算下一个点的坐标
                    tx=que[head].x+next[k][0];
                    ty=que[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数组还原
                        book[tx][ty]=1;
                        //插入新的点到队列中
                        que[tail].x=tx;
                        que[tail].y=ty;
                        que[tail].f=head;//因为这个点是从head扩展出来的,所以它的父亲是head,本题目不需要求路径,因此本句可省略

                        que[tail].s=que[head].s+1; // 步数是父亲的步数+1
                        tail++; //最后找出的tail应-1
                    }
                    if(tx==p&&ty==q){
                        flag=1;
                        break;
                    }

                }
                if(flag)
                    break;

                head++;
        }
        printf("%d",que[tail-1].s);
        return 0;
        }



posted @ 2016-07-30 09:45  Lawliet__zmz  阅读(228)  评论(0编辑  收藏  举报