题干:
在一个地图上有许多的障碍物,我们从起始点开始通过躲避障碍物,到达终点,请问最少的步数。
地图:n行m列(n,m<=50),1代表障碍,0代表路,起始点坐标(startx,starty),终点坐标(p,q).
思路介绍:
我们从第一个起始点(为方便表达,叫其为扩展点,暂时以que[head])开始,将这个扩展点能够到达的点纳入队列(que[tail]),当这个点能都到达的所有点都纳入队列之后,我们利用head++,将上次扩展点到达的点定为新的扩展点,继续重复之前操作,知道没有扩展点为止(head=tail).(详细点在代码中介绍)。
#include <stdio.h>
struct note {
int x; //横坐标
int y;//纵坐标
int s;//步数
};
int main() {
struct note que[2501];//因为地图大小不超过50*50,因此队列扩展不糊超过2500个
int a[51][51] = {0}, book[51][51] = {0};
int next[4][2] = {{0, 1}, //向右走
{1, 0}, //向下走
{0, -1}, //向左走
{-1, 0}//向上走
};
int head, tail;
int i, j, k, n, m, startx, starty, p, q, tx, ty, flag;
scanf("%d %d", &n, &m);
for (i = 1; i <= n; i++)
for (j = 1; j <= m; j++)
scanf("%d", &a[i][j]);//输入地图
scanf("%d %d %d %d", &startx, &starty, &p, &q);//开始坐标,目标坐标
head = 1;//
tail = 1;//列队初始化
que[tail].x = startx;
que[tail].y = starty;
que[tail].s = 0;//插入迷宫入口
tail++;
book[startx][starty] = 1;
flag = 0;//用来标记是否到达目的地,0表示暂时还没有到达,1表示到达
//当队列不为空的时候循环
while (head < tail) {
for (k = 0; k <= 3; k++) {//枚举四个方向
tx = que[head].x + next[k][0];
ty = que[head].y + next[k][1];//计算下一个坐标点
if (tx < 1 || tx > n || ty < 1 || ty > m)//判断是否越界
continue;
if (a[tx][ty] == 0 && book[tx][ty] == 0) {//判断是否是障碍物或者已经在路径中
book[tx][ty] = 1;//把这个点标记为已经走过
//注意宽搜每个点只入队一次,所以和深度不同,不需要将book数组还原
que[tail].x = tx;
que[tail].y = ty;//将新点插入队列
que[tail].f = head;//因为这个点是从head扩展出来的,所以他的父亲是head
//本题目不需要求路径,因此本局可省略
que[tail].s = que[head].s + 1;//步数是父亲的步数+1
tail++;
}
if (tx == p && ty == q) {//如果到目标点了,停止扩展,任务结束,退出循环
flag = 1;//
break;//这两句话一定不要写反
}
}
if (flag == 1)
break;
head++;//不要忘记,当一个点扩展结束后,head++才能对后面的点在进行扩展
}
printf("%d", que[tail - 1].s);//打印队列中末尾最后一个点的步数
//注意tail是指向队列队尾的下一个位置,所以需要-1
getchar();
return 0;
}