走迷宫,广度优先搜索
#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;
}