poj-3984

#include"iostream"
#include"algorithm"
#include"vector"
#include"queue"
#include"map"
#include"cstdio"
#include"string"
#include"stack"
#include"set"
#include"cstring"
using namespace std;
int a1[6][6];
int v[6][6];
struct node
{
    int x;
    int y;
    int s;
    int n[50];
};
node ans;
int i,j;
int d[4][2]={{0,1},{0,-1},{1,0},{-1,0}};
int x2=0;
int y2=0;
node  bfs()
{
    memset(v,0,sizeof(v));
    queue<node>q;
    node a,b;
    a.x=0;
    a.y=0;
    a.s=0;
    v[0][0]=1;
    q.push(a);
    while(!q.empty())
    {
        a=q.front();
        q.pop();
        if(a.x==4&&a.y==4)
        {
            return a;
        }
        for(i=0;i<4;i++)
        {
            b=a;
            b.x=a.x+d[i][0];
            b.y=a.y+d[i][1];
            if(v[b.x][b.y]||a1[b.x][b.y])
                continue;
            if(b.x>=0&&b.x<5&&b.y>=0&&b.y<5)
            {
                 v[b.x][b.y]=1;
                b.s=a.s+1;
                b.n[a.s]=i;
                q.push(b);

            }
        }
    }
    return a;

}
void as(node w)
{
    for(i=0;i<=w.s;i++)
    {

        printf("(%d, %d)\n",x2,y2);
        if(i!=w.s)
        {
            x2+=d[w.n[i]][0];
            y2+=d[w.n[i]][1];
        }
    }
}
int main()
{
    for(i=0;i<5;i++)
    {
        for(j=0;j<5;j++)
        {
            scanf("%d",&a1[i][j]);
        }
    }
    ans=bfs();
   as(ans);
    return 0;
}