openjudge 4127 bfs(记录路径)

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