算法学习 4.3——例题

1. 有一个5x4大小的迷宫，请你找出第一行第一列单元格到第四行第三列的最短路径。
2. 其中第一行第三列，第三行第三列，第四行第二列，第五行第四列有障碍物，无法通过。
3. 用广度优先搜索
   代码————————————————————————

#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;
}

结果：