思考一下,上次的深度优先搜索是从起点开始顺时针的顺序进行方向选择下一个路径点;那么这次的广度优先搜索,顾名思义,就是这个点可以移动到的下一步位置的所有点都进行测试,再以这些点为路径的头点,进行下一个点的搜索…
?
#include <bits/stdc++.h>
using namespace std;
const int N= 55;
struct node {
int x, y, step;};
queue<node> q;
int mp[N][N],vis[N][N];
int dir[4][2] = {-1,0,0,1,1,0,0,-1};
int n, m, sx,sy, ex, ey;
bool check(int x, int y) {
return x >= 1 && x <= n && y >= 1 && y<= m && !vis[x][y] && mp[x][y] != 1;
}
void bfs(){
//1.起点入队
vis[sx][sy] = 1;
node t= {sx,sy, 0};
q.push(t);
//2.遍历队列
while (!q.empty()) {
node f = q.front(); q.pop();
//沿着所有方向搜索,搜索所有可搜索的点
for (int i=0;i<4;i++) {
int nx = f.x + dir[i][0];
int ny = f.y + dir[i][1];
if (check(nx,ny)) {
vis[nx][ny] = 1;
node tmp = {nx,ny,f.step + 1}; q.push(tmp);
if (nx == ex && ny == ey)
return;
}
}
}
}
int main (){
cin >> n >> m;
for (int i = 1; i <= n; i++) {
for (int j= 1;j<= m;j++) {
cin >> mp[i][j];}}
cin >> sx >> sy>> ex>> ey; bfs();
cout << q.back().step;
return 0;
}