广度优先遍历的几个例题

题目来自《啊哈！算法》

1.广度优先搜索遍历二维数组迷宫

0 0 1 0

0 0 0 0

0 0 1 0

0 1 # 0

0 0 0 1

（下标从1开始，#为终点，左上角为起点）

先上代码

#include "stdafx.h"
#include "iostream"
using namespace std;
typedef struct Queue
{
	int x;
	int y;
	int step;
};
void main()
{
	int next[4][2] = { 0,1,1,0,0,-1,-1,0 };
	Queue q[21];//head          tail
	bool visited[6][5] = { false };
	int map[6][5] = { 0 };
	map[1][3] = 1;
	map[3][3] = 1;
	map[4][2] = 1;
	map[5][4] = 1;
	int tail=1, head = 1;
	q[tail].x = 1;
	q[tail].y = 1;
	q[tail].step = 0;
	visited[1][1] = true;
	tail++;    //第一个先进队列
	int tx=0, ty=0;
	int flag = 0;
	while (head < tail)//队列不为空
	{
		for (int i = 0;i <= 3;i++)    //第一个点入队列，开始对这个点进行尝试
		{
			tx = q[head].x + next[i][0];//遍历next数组，对四个方向进行尝试
			ty = q[head].y + next[i][1];
			if (tx < 1 || tx>5 || ty < 1 || ty>4)  //结束条件1，超出边界
				continue;
			if (map[tx][ty] == 0 && visited[tx][ty] == false)//条件成立，将这个位置入队列
			{
				q[tail].x = tx;
				q[tail].y = ty;
				q[tail].step = q[head].step+1;//步数是上一步的步数+1，比如之前是在1，1
				visited[tx][ty] = true;       //那么下一次是1，2和2，1入队列，这两个的step都是1，1的step+1
				tail++;                       //所以，这个for就是将某个位置周围的位置全部入队
			}                                 //全部入队后，该位置就算遍历完了，出队，然后开始重新遍历队首的位置
			if (tx == 4 && ty == 3)   //广搜搜到位置后就可以结束了，不像深搜，所以直接结束两个循环
			{
				flag = 1;break;
			}
		}
		if (flag)break;
		head++;//表示出队
	}
	cout << q[tail - 1].step;//tail指的是空的地方
}

所谓广度优先遍历，就是通过一个队列的帮助，一开始将开始位置入队，然后开始对队首的位置开始不断向周围尝试，如果可以走，比如1，1到1，2和2，1，就将这两个位置全部入队，然后1，1就算遍历完了，出队，队首变成1，2，开始对1，2向四周尝试，依次入队，然