算法:BFS广度优先搜索解决经典迷宫问题

使用BFS广度优先搜索算法解决走迷宫问题

#include<bits/stdc++.h>
using namespace std;
int array[100][100],v[100][100];
struct point
{
    
    
	int x;
	int y;
	int step;
};
//定义方向数组 
int dx[4] = {
    
    0,1,0,-1};//四个方向,右下左上 
int dy[4] = {
    
    1,0,-1,0};
queue<point> r;//开拓一个point类型的队列 
int main()
{
    
    
	//输入 
	int m,n,startx,starty,endx,endy;//输入迷宫大小 
	cin>>m>>n;
	for(int i=0;i<m;i++)
		for(int j=0;j<n;j++)
			cin>>array[m][n];//输入迷宫阵型,0为可走,1为障碍
	cin>>startx>>starty>>endx>>endy;//输入起点和终点 
	
	//BFS 广度优先搜索 
	point start;//定义一个point类型的点,并进行赋值 
	start.x=startx;
	start.y=starty;
	start.step=0;
	r.push(start);
	v[startx][starty]=1;//设置起点为已被访问 
	int flag=0;//判断能不能走到终点 
	while(!r.empty())//不为空继续拓展 
	{
    
    
		int x = r.front().x;
		int y = r.front().y;
		if(x==endx && y==endy)
		{
    
    
			cout<<r.front().step<<endl;
			flag=1;
			break;
		}
		for(int k=0;k<=3;k++)//k表示有上下左右四种情况,依次拓展 
		{
    
    
			int tx,ty;//临时拓展位置 
			tx = x + dx[k];
			ty = y + dy[k];
			if(array[tx][ty] == 0 && v[tx][ty] == 0)//若当前位置无障碍且未被访问
			{
    
    
				//入队
				 point temp;
				 temp.x = tx;
				 temp.y = ty;
				 temp.step = r.front().step + 1;
				 r.push(temp);
				 v[tx][ty]=1; //将该点设置为已访问 
			 } 
		}
		r.pop();//拓展完毕后需要将队首元素出队 
	 } 
	 if(flag == 0)
	 	cout<<"走不到终点"<<endl;	
}

样例输入:INPUT

4 4
0 0 1 0
0 1 0 0
0 0 1 0
0 0 0 0
0 0 3 2

加粗部分为起点和终点,第一行输入数组范围,最后一行输入起点坐标(0,0)和终点(3,2)

样例输出:OUTPUT

5

猜你喜欢

转载自blog.csdn.net/passer__jw767/article/details/108687496
今日推荐