1255：迷宫问题

#include<iostream>
#include<cstdio>
using namespace std;
int map[1000][1000];
int quex[1000];
int quey[1000];
int pre[1000];
int a[1000];
int b[1000];
int dx[4]={0,0,-1,1};
int dy[4]={-1,1,0,0};
void print(int d)
{
    if(pre[d]!=0)print(pre[d]);
    printf("(%d, %d)\n",a[d],b[d]);
}
int main()
{
    int i,j,flag=0,head=0,tail=1,x,y;
    for(i=0;i<=4;i++)
        for(j=0;j<=4;j++)
            cin>>map[i][j];
    quex[1]=0;
    quey[1]=0;
    map[0][0]=1;
    pre[1]=0;
    a[1]=0;
    b[1]=0;
    while(head<tail)
    {
        head++;
        for(i=0;i<=3;i++)
        {
            x=quex[head]+dx[i];
            y=quey[head]+dy[i];
            if(x>=0&&x<5&&y>=0&&y<5&&map[x][y]!=1)
            {
                tail++;
                pre[tail]=head;;
                quex[tail]=x;
                quey[tail]=y;
                a[tail]=x;
                b[tail]=y;
                map[x][y]=1;
                if(x==4&&y==4)
                {
                    print(tail);
                    flag=1;
                    break;
                }
            }
        }
        if(flag==1)break;
    }
    return 0;
}