走迷宫【广度优先搜索】

走迷宫，广度优先搜索

#include <stdio.h>
struct note
{
	int x; //横坐标
	int y; //纵坐标
	int s; //步数
	int f; //父亲在队列中的编号,队列长度
}que[2501];

int main() {
	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, n, m, k, 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;
	que[tail].f = 0;
	tail++;
	book[startx][starty] = 1;

	flag = 0;//用来标记是否到达目标点，0表示还未到达
	//当队列不为空的时候循环
	while (head < tail) {
		//枚举4个方向
		for (k = 0; k < 4; 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;//步数是父亲的步数加1
				que[tail].f = head;
				tail++;
			}
			//如果到目标点了，停止扩展，结束，退出循环
			if (tx == p&&ty == q) {
				flag = 1;
				break;
			}
		}
		if (flag == 1)
			break;
		head++;//注意当一个点扩展结束后，head++才能对后面的点在进行扩展
	}

	//注意tail是指向队列队尾（即最后一位）的下一个位置，所以这需要-1
	printf("%d", que[tail - 1].s);
	//printf("%d", que[tail - 1].f);//队列长度

	getchar(); getchar();
	return 0;
}