http://bailian.openjudge.cn/practice/4127/
#include <iostream>
#include <cstdio>
#include <cstring>
#include <queue>
#include <stack>
using namespace std;
int a[7][7];
int b[4][2]={{-1,0},{0,1},{1,0},{0,-1}};
struct node
{
int x,y;
}fa[7][7];;
void bfs()
{
queue<node> q;
q.push({0, 0});
a[0][0] =1;
while(!q.empty())
{
node t = q.front();
q.pop();
if(t.x==4&&t.y==4)
{
return;
}
for(int i=0; i<4; i++)
{
int x = t.x + b[i][0];
int y = t.y + b[i][1];
if(x<0 || x>=5 || y<0 || y>=5)
continue;
if(a[x][y]==0)
{
a[x][y] = 1;
q.push({x, y});
fa[x][y] = t;
}
}
}
}
int main()
{
for(int i=0;i<5;i++)
{
for(int j=0;j<5;j++)
{
cin >> a[i][j];
}
}
bfs();
stack<node> s;
node t{4,4};
while(1)
{
s.push(t);
if(t.x==0&&t.y==0)
break;
t=fa[t.x][t.y];
}
while(!s.empty())
{
printf("(%d, %d)\n",s.top().x,s.top().y);
s.pop();
}
return 0;
}