POJ 3984 迷宫问题 BFS+路径保存

    #include <iostream>
    #include <cstdio> 
    #include <queue> 
    using namespace std;
    int a[6][6];
    int go[4][2] = {1,0,0,1,-1,0,0,-1};
    
    
    struct node
    {
        int x;
        int y;
    }q[100];
    
    int pre[100];
    
    bool check(int x,int y)
    {
        if(x<0||x>4||y<0||y>4||a[x][y]==1)
            return false;
        else
            return true;
    }
    
    void print(int a)
    {
        if(a==0)
        {
            cout<<"("<<q[0].x<<", "<<q[0].y<<")"<<endl;
            return; 
        } 
        else
        {
            print(pre[a]);
            cout<<"("<<q[a].x<<", "<<q[a].y<<")"<<endl;
        }
    }
    
    int main()
    {
    //    freopen("data.txt","r",stdin);
        
        for(int i=0;i<5;i++)
        {
            for(int j=0;j<5;j++)
            {
                cin>>a[i][j];
            }
        }
         
        int t;
        int head = 0;
        int tail = 1;
        
        q[head].x = 0;
        q[head].y = 0;
        
        while(head!=tail)
        {    
            if(q[head].x==4 && q[head].y==4)
            {
                break;
            }
            
            for(int i=0;i<4;i++)
            {
                
                if(check(q[head].x+go[i][0],q[head].y+go[i][1]))
                { 
                    q[tail].x = q[head].x+go[i][0];
                    q[tail].y = q[head].y+go[i][1];
                    pre[tail] = head;
                    a[q[head].x][q[head].y] = 1;
                    tail++;
                }
            }
            head++;
        }
    
        print(head);
        return 0;
    }