广搜经典例题--迷宫问题POJ3894

首先定义一个矩阵：

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表示可以走的路，只能横着走或竖着走，不能斜着走，要求编程序找出从左上角到右下角的最短路线。

如：

(0, 0)
(1, 0)
(2, 0)
(2, 1)
(2, 2)
(2, 3)
(2, 4)
(3, 4)
(4, 4)

最基础的广搜。先将起始位置入队列，

每次从队列拿出一个元素，扩展其相邻的4个元素入队列（要判重），直到队头元素为终点为止。队列里的元素记录了指向父节点（上一步）的指针。队列不能用STL和quene或deque，要自己写。用一维数组实现，维护队头指针和队尾指针。

思路：

①从终点出发查找起点，方便记录路径。

②将为此走过的位置定义为不可重复走的点。

③找到起点后，可以立即返回。

我们需要找最短路径，只要最先可以达到，那么就肯定是最短路径。

代码如下：

#include <stdio.h>
#include <string.h>
#include <limits.h>
#include <queue>
using namespace std;
 
const int N = 5;
int Maze[N][N];
pair<int, int> path[N][N];
const int BLOCK = 1;
int dx[] = {1, -1, 0, 0};
int dy[] = {0, 0, 1, -1};
 
inline bool isLegal(int x, int y)
{