C++:迷宫问题(广度优先搜索)

定义一个二维数组：
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)

#include<cstdio>
#include<iostream>
#include<algorithm>
#include<queue>
struct node
{
    int x;                           //定义一个结构体，表示走到的位置
    int y;
};
using namespace std;
int main()
{
    int a[5][5];                        //地图大小5*5
    int book[5][5]={0};                 //用来标记走过的位置
    int next[4][2]={{0,1},{1,0},{0,-1},{-1,0}};        //表示下一步走的方向的数组，右下左上
    int i,j,tx,ty;
    for(i=0;i<5;i++)
        for(j=0;j<5;j++)
            scanf("%d",&a[i][j]);                       //输入地图
    queue<node>q;                      //定义队列
    node n;                            //声明结构体变量
    n.x=0,n.y=0;
    q.push(n);                         //结构体入队的方法
    cout<<"(0, 0)"<<endl;
    book[0][0]=1;                                   //走过标记
    while(1)
    {
        for(i=0;i<4;i++)
        {
            tx=q.back().x+next[i][0];
            ty=q.back().y+next[i][1];                     //计算下一个位置
            if(tx<0||tx>4||ty<0||ty>4)
                continue;                                 //判断是否越界
            if(a[tx][ty]==0&&book[tx][ty]==0)             //保证不是障碍物并且没有走过
            {                                                       
                book[tx][ty]=1;                     //标记走过
                n.x=tx,n.y=ty;
                q.push(n);                          //将这个位置入队
                cout<<"("<<tx<<", "<<ty<<")"<<endl;
                break;
            }
        }
        if(tx==4&&ty==4)                  //判断是否到达目标点
            break;
    }
    return 0;
}