POJ3984 输出路径

#include<iostream>
#include<cstdio>
#include<cstring>
#include<queue>
using namespace std;
typedef pair<int,int>P; //!!!
const int maxn = 105;
P ing[maxn][maxn];
int n,m;
int g[maxn][maxn];
int d[maxn][maxn];    //每个点到起点的距离 //没有走过 
int dx[]={0,0,-1,1};
int dy[]={1,-1,0,0};
struct node
{
    int x,y;
}st[maxn];
void bfs()
{
    queue<P>q;
    memset(d,-1,sizeof(d));
    d[0][0]=0;
    q.push({0,0});
    while(!q.empty())
    {
        P t = q.front();
        q.pop();
        for(int i=0;i<4;i++)
        {
            int x=dx[i]+t.first;
            int y=dy[i]+t.second;
            if(x>=0&&y>=0&&x<5&&y<5&&g[x][y]==0&&d[x][y]==-1)
            {
                d[x][y]=d[t.first][t.second]+1;
                ing[x][y].first=t.first;
                ing[x][y].second=t.second;
                q.push({x,y});
            }
        }
    }
    return ;
}
int main()
{
    //cin>>n>>m;
    for(int i=0;i<5;i++)
        for(int j=0;j<5;j++)
            cin>>g[i][j];
    bfs();
    int x=4,y=4;
    int tot=0;
    while(!(x==0&&y==0))
    {
        st[tot].x=x;
        st[tot].y=y;
        tot++;
        int tx=x,ty=y;
        x=ing[tx][ty].first;
        y=ing[tx][ty].second;
    }
    cout<<"(0, 0)"<<endl;
    for(int i=tot-1;i>=0;i--)
        printf("(%d, %d)\n",st[i].x,st[i].y);
    return 0;
}