迷宫探索

/*
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是指向队列队尾(即最后一位)的下一个位置,所以这须要-1cout<<que[tail-1].s<<endl;return 0;
}