#include<bits/stdc++.h>
using namespace std;
int a[100][100],v[100][100];//地图,访问数组
struct point{
int x;int y;int step;//横纵坐标,步数
};
queue <point> r;//队列
int dx[4]={1,0,-1,0};//偏移坐标
int dy[4]={0,-1,0,1};
int main(){
int n,m,startx,starty,p,q;//起点,终点坐标
scanf("%d%d",&n,&m);//输入地图
for(int i=1;i<=n;i++){
for(int j=1;j<=m;j++){
scanf("%d",&a[i][j]);
}
}
scanf("%d%d%d%d",&startx,&starty,&p,&q);
point start;//定义结构体起点
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,y=r.front().y;
if(x==p && y==q){//是否到达出口
flag=1;
printf("%d",r.front().step);
break;
}
for(int k=0;k<=3;k++){// 拓展新点
int tx,ty;
tx=x+dx[k];
ty=y+dy[k];
if(a[tx][ty]==1 && 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) printf("no answer!");
return 0;
}
BFS解决迷宫问题
最新推荐文章于 2024-10-03 23:25:47 发布