BFS解决迷宫问题

#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;
}
评论 1
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值