【bfs】 poj 3984 maze 队列存储

#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)
",path[tmp].x,path[tmp].y);
     }
     else
     {
         output(tmp);
     }
      printf("(%d, %d)
",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()
 {
//     freopen("in.txt","r",stdin);
     int i,j;
     for(i=0;i<5;i++)
     {
         for(j=0;j<5;j++)
         {
             scanf("%d",&map[i][j]);
         }
     }
     bfs();
     return 0;
 }