解救人质 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; }