I - 迷宫问题

定义一个二维数组：

int maze[5][5] = {

0, 1, 0, 0, 0,

0, 1, 0, 1, 0,

0, 0, 0, 0, 0,

0, 1, 1, 1, 0,

0, 0, 0, 1, 0,

};

它表示一个迷宫，其中的1表示墙壁，0表示可以走的路，只能横着走或竖着走，不能斜着走，要求编程序找出从左上角到右下角的最短路线。
Input
一个5 × 5的二维数组，表示一个迷宫。数据保证有唯一解。
Output
左上角到右下角的最短路径，格式如样例所示。
Sample Input
0 1 0 0 0
0 1 0 1 0
0 0 0 0 0
0 1 1 1 0
0 0 0 1 0
Sample Output
(0, 0)
(1, 0)
(2, 0)
(2, 1)
(2, 2)
(2, 3)
(2, 4)
(3, 4)
(4, 4)

bfs搜索＋队列储存
    /**/
    #include<stdio.h>
    #include<bits/stdc++.h>
    using namespace std;
    int mmap[6][6];
    int vis[6][6];
    struct date
    {
        int x,y;
    };
    queue<date>q;
    date fa[5][5];
    int g[4][2]={{0,1},{0,-1},{-1,0},{1,0}};
    int fi(struct date k)
    {
        if(k.x>=0&&k.x<=4&&k.y>=0&&k.y<=4)
            return 1;
        else
            return 0;
    }
    void bfs(int a,int b)
    {
        date t,v,u;
        t.x=a;
        t.y=b;
        q.push(t);
        vis[a][b]=1;
        while(!q.empty())
        {
            v=q.front();
            q.pop();
            for(int i=0;i<4;i++)
            {
                u.x=v.x+g[i][0];
                u.y=v.y+g[i][1];
                if(fi(u)&&!vis[u.x][u.y]&&!mmap[u.x][u.y])
                {
                    q.push(u);
                    vis[u.x][u.y]=1;
                    fa[u.x][u.y]=v;
                }
            }
        }
    }
    int main()
    {
        int i,j;
        stack<date>s;
        date t;
        memset(vis,0,sizeof(vis));
        for(i=0;i<5;i++)
        {
            for(j=0;j<5;j++)
            {
                scanf("%d",&mmap[i][j]);
            }
        }
        while(!q.empty())
        {
            q.pop();
        }
        bfs(0,0);
        t=fa[4][4];
        while(t.x!=0||t.y!=0)
        {
           s.push(t);
           t=fa[t.x][t.y];
        }
        printf("(0, 0)\n");
        while(!s.empty())
        {
            t=s.top();
            printf("(%d, %d)\n",t.x,t.y);
            s.pop();
        }
        printf("(4, 4)\n");
        return 0;
    }