- 有一个5x4大小的迷宫,请你找出第一行第一列单元格到第四行第三列的最短路径。
- 其中第一行第三列,第三行第三列,第四行第二列,第五行第四列有障碍物,无法通过。
- 用广度优先搜索
代码————————————————————————
#include <stdio.h>
struct node {
int x;//横坐标
int y;//纵坐标
int s;//步数
};
int main()
{
struct node que[2501];
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[head].x = startx;
que[head].y = starty;
que[tail].s = 0;
tail++;
book[startx][starty] = 0;
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数组还原
book[tx][ty] = 1;
//插入新的点到队列中
que[tail].x = tx;
que[tail].y = ty;
que[tail].s = que[head].s + 1;
tail++;
}
//如果到目标点了,停止扩展,任务结束,退出循环
if (tx == p && ty == q)
{
flag = 1;
break;
}
}
if (flag == 1)
break;
head++;
}
//打印队列中末尾最后一个点的步数
//注意tail是指向队列队尾的下一个位置,所以需要-1
printf("%d", que[tail - 1].s);
return 0;
}
结果: