使用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