广度优先搜索
2017-03-07 本文已影响0人
say_no
题目原意:
小哼去解救小哈,地图为矩阵,上面有许多障碍物。求解救小哈的最短路径。
INPUT
第一行:两个数据,行数n和列数m,中间用空格隔开
接下来的n行m列:输入迷宫,0表示空地,1表示障碍物,每一行的每个数用空格隔开
最后一行:四个数据,前两个为迷宫入口的坐标,后两个为小哈的x和y坐标
#include <cstdio>
struct note
{
int x;//横坐标
int y;//纵坐标
int f;//父亲在队列中的编号,本题不要求输出路径,可以不需要f
int s;//步数
};
/*
数据:
5 4
0 0 1 0
0 0 0 0
0 0 1 0
0 1 0 0
0 0 0 1
1 1 4 3
*/
int main()
{
struct note que[2501];//应为地图大小不超过50*50,因此队列扩展不会超过2500个
int a[51][51]={0},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,startx,starty,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",&startx,&starty,&p,&q);
//队列初始化
head=1;
tail=1;
//往队列插入迷宫入口坐标
que[tail].x=startx;
que[tail].y=starty;
que[tail].f=0;
que[tail].s=0;
tail++;
book[startx][starty]=1;
flag=0;//用来标记是否达到目标终点,0表示还没有到达,1表示到达
//当队列不为空的时候循环
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;
tail++;
}
//如果到达目标点了,停止扩展,任务结束,退出循环
if(tx==p&&ty==q)
{
//下面两句话的位置不能写颠倒了
flag=1;
break;
}
}
if(flag==1)
break;
head++;//注意这地方千万不要忘记,当一个点扩展结束后,head++才能对后面的点再进行扩展
}
//打印队列中末尾最后一个(目标点)的步数
//注意tail是指向队列队尾(即最后一位)的下一个位置,所以这需要-1
printf("%d",que[tail-1].s);
getchar();getchar();
return 0;
}