迷宫探索

/*
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
*/

#include<iostream>

using namespace std;

struct node 
{
	int x;//横坐标
	int y;//纵坐标
	int f;//父亲在队列中的编号
	int s;//步数
};

int main()
{
	node que[2051];
	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,startx,starty,p,q,tx,ty,flag;
		cin>>n>>m;
		for(int i=1;i<=n;i++)
	{
			for(int j=1;j<=m;j++)
		{
				cin>>a[i][j];
		}
	}
	cin>>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)
	{
		//枚举4个方向
		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[tx][ty]=1;
				que[tail].x=tx;
				que[tail].y=ty;
				que[tail].f=head;
				que[tail].s=que[head].s+1;
				tail++;
			}
			if(tx==p&&ty==q)
			{
				flag=1;
				break;
			}
		}
		if(flag==1)
			break;
		head++;
	}
	//打印队列中末尾最后一个点(目标点)的步数
	//注意tail是指向队列队尾(即最后一位)的下一个位置,所以这需要-1
	cout<<que[tail-1].s<<endl;
	return 0;
}