宽搜可以搜到最短路径:
#include
#include
#include
#include
using namespace std;
typedef pair<int, int> PII;
const int N = 110;
int n, m;
int g[N][N], d[N][N];//g[N][N]用来存储迷宫 d[x][y]用来存储(x,y)这一点到坐标原点的距离
int bfs() {
queue<PII> q; //q队列用来存储宽度优先搜素到的路径也就是走迷宫经过哪些点
memset(d, -1, sizeof (d)); //将d数组所有元素初始化为-1
d[0][0] = 0; //位于原点时到原点的距离为0
q.push({0, 0}); //将原点入队
int dx[4] = {-1, 0, 1, 0}, dy[4] = {0, 1, 0, -1}; //定义方向向量一共四个方向
while (q.size()) { //当队列非空时执行循环
auto t = q.front();
q.pop(); //插入一个位置的同时会弹出一个位置保证循环可以正常终止
for (int i = 0; i < 4; i++) { //x,y都要四个方向,遍历四个方向
int x = t.first + dx[i], y = t.second + dy[i]; //四个方向对应x,y坐标
if (x >= 0 && x < n && y >= 0 && y < m && g[x][y] == 0 && d[x][y] == -1) {
d[x][y] = d[t.first][t.second] + 1; //走到下一个点的同时距离加1
q.push({x, y}); //将该点入队
}
}
}
return d[n - 1][m - 1]; //递归回下一个点
}
int main() {
cin >> n >> m;
for (int i = 0; i < n; i++)
for (int j = 0; j < m; j++)
cin >> g[i][j];
cout << bfs() << endl;
return 0;
}