變數 head 和 tail 是隊頭和隊尾指標， head 總是指向隊頭， tail 總是指向隊尾的下一個元素。每個點的 predecessor 成員也是一個指標，指向它的前趨在 queue 陣列中的位置。如下圖所示：

廣度優先是一種步步為營的策略，每次都從各個方向探索一步，將前線推進一步，圖中的虛線就表示這個前線，佇列中的元素總是由前線的點組成的，可見正是佇列先進先出的性質使這個演算法具有了廣度優先的特點。廣度優先搜尋還有一個特點是可以找到從起點到終點的最短路徑，而深度優先搜尋找到的不一定是最短路徑。

#include <stdio.h>
#define MAX_ROW 5
#define MAX_COL 5
struct point { int row, col, predecessor; } queue[512];
int head = 0, tail = 0;
void enqueue(struct point p)
{
	queue[tail++] = p;
}
struct point dequeue(void)
{
	return queue[head++];
}
int is_empty(void)
{
	return head == tail;
}
int maze[MAX_ROW][MAX_COL] = {
	0, 1, 0, 0, 0,
	0, 1, 0, 1, 0,
	0, 0, 0, 0, 0,
	0, 1, 1, 1, 0,
	0, 0, 0, 1, 0,
};
void print_maze(void)
{
	int i, j;
	for (i = 0; i < MAX_ROW; i++) {
		for (j = 0; j < MAX_COL; j++)
		printf("%d ", maze[i][j]);
		putchar('\n');
	}
	printf("*********\n");
}

void visit(int row, int col)
{
	struct point visit_point = { row, col, head-1 };
	maze[row][col] = 2;
	enqueue(visit_point);
}
int main(void)
{
	struct point p = { 0, 0, -1 };
	maze[p.row][p.col] = 2;
	enqueue(p);
	while (!is_empty()) {
		p = dequeue();
		if (p.row == MAX_ROW - 1 /* goal */
		&& p.col == MAX_COL - 1)
		break;
		if (p.col+1 < MAX_COL /* right */
		&& maze[p.row][p.col+1] == 0)
		visit(p.row, p.col+1);
		if (p.row+1 < MAX_ROW /* down */
		&& maze[p.row+1][p.col] == 0)
		visit(p.row+1, p.col);
		if (p.col-1 >= 0 /* left */
		&& maze[p.row][p.col-1] == 0)
		visit(p.row, p.col-1);
		if (p.row-1 >= 0 /* up */
		&& maze[p.row-1][p.col] == 0)
		visit(p.row-1, p.col);
		print_maze();
	}
	if (p.row == MAX_ROW - 1 && p.col == MAX_COL - 1)
	{
		printf("(%d, %d)\n", p.row, p.col);
		while (p.predecessor != -1) {
			p = queue[p.predecessor];
			printf("(%d, %d)\n", p.row,	p.col);
		}
	} else
	printf("No path!\n");
	return 0;
}
 

[[email protected] arithmetic]# ./maze2.out 
2 1 0 0 0 
2 1 0 1 0 
0 0 0 0 0 
0 1 1 1 0 
0 0 0 1 0 
*********
2 1 0 0 0 
2 1 0 1 0 
2 0 0 0 0 
0 1 1 1 0 
0 0 0 1 0 
*********
2 1 0 0 0 
2 1 0 1 0 
2 2 0 0 0 
2 1 1 1 0 
0 0 0 1 0 
*********
2 1 0 0 0 
2 1 0 1 0 
2 2 2 0 0 
2 1 1 1 0 
0 0 0 1 0 
*********
2 1 0 0 0 
2 1 0 1 0 
2 2 2 0 0 
2 1 1 1 0 
2 0 0 1 0 
*********
2 1 0 0 0 
2 1 2 1 0 
2 2 2 2 0 
2 1 1 1 0 
2 0 0 1 0 
*********
2 1 0 0 0 
2 1 2 1 0 
2 2 2 2 0 
2 1 1 1 0 
2 2 0 1 0 
*********
2 1 0 0 0 
2 1 2 1 0 
2 2 2 2 2 
2 1 1 1 0 
2 2 0 1 0 
*********
2 1 2 0 0 
2 1 2 1 0 
2 2 2 2 2 
2 1 1 1 0 
2 2 0 1 0 
*********
2 1 2 0 0 
2 1 2 1 0 
2 2 2 2 2 
2 1 1 1 0 
2 2 2 1 0 
*********
2 1 2 0 0 
2 1 2 1 2 
2 2 2 2 2 
2 1 1 1 2 
2 2 2 1 0 
*********
2 1 2 2 0 
2 1 2 1 2 
2 2 2 2 2 
2 1 1 1 2 
2 2 2 1 0 
*********
2 1 2 2 0 
2 1 2 1 2 
2 2 2 2 2 
2 1 1 1 2 
2 2 2 1 0 
*********
2 1 2 2 0 
2 1 2 1 2 
2 2 2 2 2 
2 1 1 1 2 
2 2 2 1 2 
*********
2 1 2 2 2 
2 1 2 1 2 
2 2 2 2 2 
2 1 1 1 2 
2 2 2 1 2 
*********
2 1 2 2 2 
2 1 2 1 2 
2 2 2 2 2 
2 1 1 1 2 
2 2 2 1 2 
*********
(4, 4)
(3, 4)
(2, 4)
(2, 3)
(2, 2)
(2, 1)
(2, 0)
(1, 0)
(0, 0)