[poj3984]迷宫问题_bfs

#include <iostream>
#include <cstdio>
#include <cstring>
#include <algorithm>
#include <queue>
using namespace std;
struct Pair
{
	int x,y;
};
int a[10][10];
queue<Pair> q;
Pair before[10][10];
Pair ans[50];
bool dis[10][10];
int d[5][3]={{0,0,0},{0,1,0},{0,-1,0},{0,0,1},{0,0,-1}};
bool check(int x,int y)//判断当前点是否合法
{
	if(x>=0&&x<=4&&y>=0&&y<=4&&a[x][y]==0) return true;
	return false;
}
int main()
{
	for(int i=0;i<5;i++)
	{
		for(int j=0;j<5;j++)
		{
			scanf("%d",&a[i][j]);
		}
	}
	Pair mid;
	mid.x=0;
	mid.y=0;
	q.push(mid);//起始暴搜点
	dis[0][0]=1;
	while(!q.empty())
	{
		mid=q.front();q.pop();
		int x=mid.x,y=mid.y;
		if(x==4&&y==4) break;
		for(int i=1;i<=4;i++)
		{
			if(check(x+d[i][1],y+d[i][2])&&dis[x+d[i][1]][y+d[i][2]]==false)
			{
				dis[x+d[i][1]][y+d[i][2]]=1;
				Pair c;
				c.x=x+d[i][1];c.y=y+d[i][2];
				q.push(c);before[c.x][c.y]=mid;
			}
		}
	}
	Pair k;
	k.x=4,k.y=4;
	int cnt=0;
	ans[++cnt]=k;
	bool flag=false;
	while(1)
	{
		if(flag) break;
		k=before[k.x][k.y];
		ans[++cnt]=k;
		if(!k.x&&!k.y) flag=true; 
	}
	for(int i=cnt;i>=1;i--)//答案要求从左上角输出至右下角
	{
		printf("(%d, %d)\n",ans[i].x,ans[i].y);
	}
	return 0;
}