解救小哈——广度优先搜索bfs

有一天，小哈一个去玩迷宫。但是方向感很不好的小哈很快就迷路了。小哼得知后便立即去解救无助的小哈。小哼当然是有备而来，已经弄清楚了迷宫地图，现在小哼要以最快速度去解救小哈。问题就此开始了……
　　迷宫由n行m列的单元格组成，每个单元格要么是空地，要么是障碍物。你的任务是帮助小哼找到一条从迷宫的起点到小哈所在位置的最短路径，注意障碍物是不能走的，当然也不能走到迷宫之外。n和m都小于等于100。

输入格式:

第一行有两个数N M。N表示迷宫的行，M表示迷宫的列。接来下来N行M列为迷宫，0表示空地，1表示障碍物。最后一行4个数，前两个数为迷宫入口的x和y坐标。后两个为小哈的x和y坐标。

输出格式:

一个整数表示小哼到小哈的最短步数。如果不能解救小哈则输出No Way!

提示:

RQNOJ 34紧急援救
195校园迷宫

样例 1 :

输入:
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

输出:
7

样例 2 :

输入:
3 3
1 1 1 
0 1 0  
0 1 0 
2 1 3 3

输出:
No Way!

 

#include <stdio.h>

typedef struct note{//创建一个结构 
	int x;//存放想x坐标 
	int y;//存放y坐标 
	int f;//存放父亲节点 
	int s;//步数 
}NOTE;

int main()
{
	NOTE p[10001];//创建一个队列 
	int a[101][101]={0},book[101][101]={0};//a存放，book标记已走过的点 
	int n,m,i,j,flag=0,x0,y0,endx,endy,tx,ty;
	//x0，y0存放初始位置坐标，，flag标记变量，endx，endy存放小哈位置坐标 
	int next[4][2]={{0,1},{1,0},{0,-1},{-1,0}};//有一个二维数组表示方向 
	int tail=1,head=1;//初始化队列 
	
	
	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",&x0,&y0,&endx,&endy);
	//初始化 
	p[tail].x=x0;
	p[tail].y=y0;
	p[tail].f=0;
	p[tail].s=0;
	
	tail++;
	book[x0][y0]=1;
	while(head<tail)
	{
		for(i=0;i<4;i++)//分别探索每个方向 
		{
			tx=p[head].x+next[i][0];
			ty=p[head].y+next[i][1];
			
			if(tx<1||tx>n||ty<1||ty>m)//判断边界 
				continue;
				
			if(book[tx][ty]==0&&a[tx][ty]==0)//未走过，没有障碍物则探索 
			{
				book[tx][ty]=1;//标记 
				p[tail].x=tx;//存入队列 
				p[tail].y=ty;
				p[tail].f=head;//记入父亲节点 
				p[tail].s=p[head].s+1;//记录步数 
				tail++;
			}
			
			if(tx==endx&&ty==endy)//如果到达目标点则标记并退出循环 
			{
				flag=1;
				break;
			}
		}
		
		if(flag==1) break;
		head++;//拓展队列 
	}
	
	if(flag==1)//判断是否解救成功，并输出数据 
	{
		printf("%d\n",p[tail-1].s);
	}
	else
		printf("No Way!\n");
	return 0;
} 

测题网址：https://www.acoj.com/problems/12032