首先定义一个矩阵:
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)
{