迷宮探索

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

?