迷宫问题
问题描述
迷宫由n行m列的单元格组成(n,m都<=50),每个单元格要么是空地,要么是障碍物。现请你找到一条从起点到终点的最短路径长度。
算法:
1、将起点入队;
2、队首结点可拓展的点入队,如果没有可拓展的点,将队首结点出队,重复该步骤,直到到达目标位置或队列为空。
代码实现
#include<bits/stdc++.h>
using namespace std;
int a[100][100];// 地图
int v[100][100];// 访问
struct point{
int x;
int y;
int step;
};
queue<point> r;// 申请队列
int dx[4]={0,1,0,-1};// 四个方向,右下左上
int dy[4]={1,0,-1,0};
/*
5 4
1 1 2 1
1 1 1 1
1 1 2 1
1 2 1 1
1 1 1 2
1 1 4 3
*/
int main(){
int n,m;// 行列
int 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);
// BFS
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搜索到的结果一定是最短的。BFS运用到了队列。