如何用队列实现广度优先算法
Posted 学益得智能硬件
tags:
篇首语:本文由小常识网(cha138.com)小编为大家整理,主要介绍了如何用队列实现广度优先算法相关的知识,希望对你有一定的参考价值。
struct Box //表示一个格子的位置信息
{
int x; //横坐标
int y; //纵坐标
int pre; //前一个格子再在队列里面存放的位置(下标)
};
typedef struct Box Box;
//顺序队列存放路径的信息
struct Queue
{
Box data[SIZE];
int front;
int rear;
};
typedef struct Queue Queue;
int map[6][6] = {
{0, 0, 0, 1, 1, 1},
{1, 1, 0, 0, 0, 0},
{1, 1, 0, 1, 1, 0},
{1, 1, 0, 0, 0, 0},
{1, 1, 1, 0, 1, 1},
{1, 1, 1, 0, 0, 1},
};
//初始化顺序队列
int InitQueue(Queue *q)
{
q->front = q->rear = -1;
return 1;
}
//进队操作
int push(Queue *q, Box b)
{
if (q->rear == SIZE - 1)
{
return 0;
}
(q->rear)++;
q->data[q->rear] = b;
return 1;
}
//判断队列是否为空
int EmptyQueue(Queue *q)
{
return (q->front == q->rear) ? 1 : 0;
}
//出队操作(只是操作对头指针,元素实际还保留在队列中)
int pop(Queue *q, Box *b)
{
if (q->front == q->rear)
{
return 0;
}
(q->front)++;
*b = q->data[q->front];
return 1;
}
//打印路径
void ShowPath(Queue *q, int front)
{
int p = front, tmp;
while (p != 0)
{
tmp = q->data[p].pre;
q->data[p].pre = -1;
p = tmp;
}
int i;
for (i = 0; i <= q->rear; i++)
{
if (q->data[i].pre == -1)
{
printf("(%d, %d)->", q->data[i].x, q->data[i].y);
}
}
printf(" ");
}
//入口(0,0) 出口(5,4)
int Walk(Queue *q, int x1, int y1, int x2, int y2)
{
Box now;
int i, j, i0, j0;
now.x = x1;
now.y = y1;
now.pre = -1;
push(q, now); //入口信息入队
map[x1][y1] = -1;
while (EmptyQueue(q) != 1)
{
pop(q, &now);
i = now.x;
j = now.y;
if (i == x2 && j == y2) //出口
{
ShowPath(q, q->front);
return 1;
}
int dir;
for (dir = 0; dir < 4; dir++) //循环四次,遍历四个方向 上 右 下 左
{
switch(dir)
{
case 0: //方向上
i0 = i - 1;
j0 = j;
break;
case 1: //方向又
i0 = i;
j0 = j + 1;
break;
case 2: //方向下
i0 = i + 1;
j0 = j;
break;
case 3: //方向左
i0 = i;
j0 = j - 1;
break;
}
//判断该点是否可走
if (i0 >= 0 && j0 >= 0 && i0 <= 5 && j0 <= 5 && map[i0][j0] == 0) //格子可以走
{
now.x = i0;
now.y = j0;
now.pre = q->front;
push(q, now);
map[i0][j0] = -1; //该点已经走过
}
}
}
return 0;
}
int main()
{
Queue queue;
InitQueue(&queue);
if (Walk(&queue, 0, 0, 5, 4) == 0)
{
printf("路径不存在 ");
}
return 0;
}
以上是关于如何用队列实现广度优先算法的主要内容,如果未能解决你的问题,请参考以下文章
(c++)迷宫自动寻路-队列-广度优先算法-附带寻路打印动画