poj 3984

#include<cstdio>
#include<iostream>
#include<cstring>
#include<algorithm>
#include<vector>
#include<queue>
using namespace std;
int a[5][5],visit[5][5];
int m[4][2]={{1,0},{0,1},{-1,0},{0,-1}};
vector<pair<int,int> > q;
void bfs(int x,int y)
{
	memset(visit,-1,sizeof(visit));
	queue<pair<int,int> >q;
	q.push(make_pair(0,0));
	visit[0][0]=0;
	while(!q.empty()){
		pair<int,int> now=q.front();
		q.pop();
		for(int i=0;i<4;i++){
			int xx=now.first+m[i][0];
			int yy=now.second+m[i][1];
			if(0<=xx&&xx<5&&0<=yy&&yy<5&&visit[xx][yy]==-1&&a[xx][yy]==0){
				visit[xx][yy]=visit[now.first][now.second]+1;
				q.push(make_pair(xx,yy));
			}
		}
		if(visit[4][4]!=-1) break;
	}
 } 
void solve(int x,int y)
{
	for(int i=0;i<4;i++){
		int xx=x+m[i][0];
		int yy=y+m[i][1];
		if(xx==0&&yy==0){
			q.push_back(make_pair(0,0));
			return ;
		}
		if(a[xx][yy]==0&&visit[x][y]-visit[xx][yy]==1){
			q.push_back(make_pair(xx,yy));
			solve(xx,yy);
			return ;
		}
	}
 } 
int main()
{
	for(int i=0;i<5;i++)
		for(int j=0;j<5;j++)
			scanf("%d",&a[i][j]);
	bfs(0,0);
//	for(int i=0;i<5;i++){
//		for(int j=0;j<5;j++)
//			printf("%d ",visit[i][j]);
//		printf("\n");
//	}
		
//	printf("%d\n",visit[4][4]);
	q.push_back(make_pair(4,4));
	solve(4,4);
	for(int i=q.size()-1;i>=0;i--){
		pair<int,int> temp=q[i];
		printf("(%d, %d)\n",temp.first,temp.second);
	}
 }