迷宫最短路问题——广搜

问题描述：

存在这样一个迷宫：

int mg[5][5]={
    {0,0,0,0,0},
    {0,1,0,1,0},
    {0,1,1,0,0},
    {0,1,1,0,1},
    {0,0,0,0,0}

};

求一条从起点 (0，0) 到终点 (4，4) 的最短路，并打印出路径。

思路：

广度优先搜索，从 (0，0) 开始，将它下一步能到达的全部点标记出来，(0，1) 和 (1，0) ，然后将其状态标记为 -1，接下来对 (0，1) 和 (1，0) 做相同的操作，具体先操作哪个和你定义的行进方向有关，和深搜很相似，直到有一条路先到达终点，程序结束，先到达的那个就是最短路，因为每走一步都会试遍所有可走的路。然而路很好找，要将它打印出来，就有点问题了，我们在这里用到的数据结构是队列，手动运行一下(规定 上右下左 为判断方向的顺序)：

(0 , 0) 入队，判断之后，(0，1) 入队，(1，0)入队，(0，0) 状态标记为 -1，开始判断 (0，1)，(0，2) 入队，状态标记为 -1，开始判断 (1，0)，(2，0)入队，状态标记为 -1，开始判断 (0，2) ......

到达终点后，队列里存在一条完整的路径，但是其中也夹杂着没有走完