poj 3984 bfs

#include<iostream>
#include<stdio.h>
#include<cstring>
#define Max 0x7f7f7f7f
using namespace std;
int map[6][6];
int visited[6][6];
int dir[4][2]={{1,0},{-1,0},{0,-1},{0,1}};
int ans[6][6];
int pre[30];
struct node
{
    int x;
    int y;
};
node path[30];
void output(int head)
{
    int tmp=pre[head];
    if(tmp==0)
        printf("(%d, %d)\n",path[tmp].x,path[tmp].y);
    else
        output(tmp);
     printf("(%d, %d)\n",path[head].x,path[head].y);
}
void bfs()
{
    memset(visited,0,sizeof(visited));
    memset(ans,Max,sizeof(ans));
    int head=0;
    int tail=1;
    pre[head]=-1;
    path[head].x=0;
    path[head].y=0;
    visited[path[head].x][path[head].y]=1;
    while(head<tail)
    {
        int x=path[head].x;
        int y=path[head].y;
        if(x==4 && y==4)
        {
            output(head);
            return ;
        }
        for(int i=0;i<4;i++)
        {
            int xx=x+dir[i][0];
            int yy=y+dir[i][1];
            if(visited[xx][yy]==0 && xx>=0 && xx<5 && yy>=0 && yy<5 && map[xx][yy]!=1)
            {
                path[tail].x=xx;
                path[tail].y=yy;
                pre[tail]=head;
                tail++;
                visited[xx][yy]=1;
            }
        }
        head++;
    }
}
int main()
{
    int i,j;
    for(i=0;i<5;i++)
        for(j=0;j<5;j++)
            scanf("%d",&map[i][j]);
    bfs();
    return 0;
}