走迷宫（蓝桥C++）bfs广度优先搜索

题目描述

给定一个 N×M 的网格迷宫 G。G 的每个格子要么是道路，要么是障碍物（道路用 1 表示，障碍物用 0 表示）。

已知迷宫的入口位置为 (x1​,y1​)，出口位置为 (x2​,y2​)。问从入口走到出口，最少要走多少个格子。

输入描述

输入第 1 行包含两个正整数 N,M，分别表示迷宫的大小。

接下来输入一个N×M 的矩阵。若 Gi,j​=1 表示其为道路，否则表示其为障碍物。

最后一行输入四个整数 x1​,y1​,x2​,y2​，表示入口的位置和出口的位置。

1≤N,M≤102，0≤Gi,j​≤1，1≤x1​,x2​≤N，1≤y1​,y2​≤M。

输出描述

输出仅一行，包含一个整数表示答案。

若无法从入口到出口，则输出 −1。

输入输出样例

示例 1

输入

5 5 
1 0 1 1 0
1 1 0 1 1 
0 1 0 1 1
1 1 1 1 1
1 0 0 0 1
1 1 5 5 

输出

8

解析 

这种题用bfs，不能用dfs暴力解决。

#include<iostream>
#include<queue>
//#include<bits/stdc++.h>
using namespace std;
int a[103][103];
int mark[103][103];//用于标记是否走过该位置 
int addx[4]={0,1,0,-1};
int addy[4]={1,0,-1,0};
struct point{//点位置坐标以及此时步数 
	int x;
	int y;
	int step;
};
queue<point> p;//建立队列p（队列先进先出规则） 
int main(){
	int m,n,sx,sy,endx,endy;
	cin>>m>>n;
	for(int i=1;i<=m;i++){
		for(int j=1;j<=n;j++){
			cin>>a[i][j];
		}
	}
	cin>>sx>>sy>>endx>>endy;
	point start;
	start.x=sx;start.y=sy;start.step=0;
	p.push(start);//push()插入 
	mark[sx][sy]=1;
	int zll=0;
	while(!p.empty()){
		int x=p.front().x;
		int y=p.front().y;
		if(x==endx&&y==endy){//此条件成立说明能到达终点 
			zll=1;//标记能达到终点 
			cout<<p.front().step;//达到终点输出最终步数 
			break;//结束while循环 
		}
		for(int i=0;i<4;i++){//四个方向右、下、左、上 
			int tx=x+addx[i];
			int ty=y+addy[i];
			if(a[tx][ty]==1&&mark[tx][ty]==0){
				point temp;
				temp.x=tx;
				temp.y=ty;
				temp.step=p.front().step+1;
				p.push(temp);//插入队尾 
				mark[tx][ty]=1;
			}
		}
		p.pop();//出队（先进先出原则，出的肯定是队头） 
	}
	if(zll==0)
	cout<<-1;
	return 0;
}