POJ3984 迷宫问题 BFS

#include<iostream>
#include<cstring>
#include<queue>
using namespace std;
int maze[5][5];
bool vis[5][5];
const int dx[]={1,0,0,-1};  
const int dy[]={0,1,-1,0}; 

struct site
{
	int x,y;
	int px,py;
	site(int i,int j):x(i),y(j){}
	site(){}
}a[10][10];

queue<site> q;
void print_ans(int x,int y) 
{                      
    if(a[x][y].px!=-1&&a[x][y].py!=-1)  
        print_ans(a[x][y].px,a[x][y].py);  
    printf("(%d, %d)\n",x,y);  
}  

void bfs()
{
	memset(vis,0,sizeof(vis));
	vis[0][0]=true;
	a[0][0].px=-1;
	a[0][0].py=-1;

	q.push(site(0,0));
	while(!q.empty())
	{
		site temp=q.front();

		q.pop();
		int x=temp.x,y=temp.y;
		for(int i=0;i<4;i++)
		{
			int nex=x+dx[i];  
            int ney=y+dy[i];  
			if(nex>=0&&nex<5&&ney>=0&&ney<5 && vis[nex][ney]==false && maze[nex][ney]==0)
			{
				a[nex][ney].px=x;
				a[nex][ney].py=y;
				if(nex==4&&ney==4) return;

				q.push(site(nex,ney));
				vis[nex][ney]=true;
			}
		}
	}
}

int main()
{
	for(int i=0;i<5;i++)
		for(int j=0;j<5;j++)
			cin>>maze[i][j];
	
	bfs();
	print_ans(4,4);
}