算法基础（六）：广度优先探索迷宫路径（队列实现！）—超详细版！

前面有一篇是深度优先思想利用栈实现的迷宫路径，

感兴趣的朋友请进这里： 

算法基础（二）：栈的应用--迷宫解题（超详细版！）

今天带来的是，用另一种数据结构--队列实现迷宫解题。简单的实现了下。

基本思想是这样的：通过一个可行的点A，向其周围探索，得到其他可行的点B(i)，并加入队列，B(i)的前驱便是A。这样循环下去，直到找到终点。

然后通过前驱关系，输出路径。这便是老师口中说的floodfill算法，图中所有的空格都会走一遍。和之前用栈实现的不同，那是深度优先，一条路走到底，不行退回来，走另外一条，直至找到终点。

下面给出代码：

#include"Basic_Symbol.h"
#include"stdafx.h"
#include"ZJC_Queue.h"

/*
	广度优先探索迷宫路经（超详细版！）

*/
int MAP[9][9] =		/*二维数组就够用了，先从简单的地图开始*/
{  
   //0 1 2 3 4 5 6 7 8
	 
	 0,0,0,0,0,0,0,0,0,
	 0,1,0,0,1,1,1,1,0,
	 0,1,0,0,1,1,1,0,0,
	 0,1,1,1,1,0,1,1,0,
	 0,1,0,1,0,1,1,1,0,
	 0,1,0,1,0,1,0,0,0,
	 0,1,0,0,0,1,1,1,0,
	 0,0,0,1,1,1,0,1,0,
	 0,0,0,0,0,0,0,0,0,


};
void MAZH_SOLVE(int endx,int endy);
void print(LinkQueue Robot,QueuePtr EndPoint);			//打印路径
void AddtoQueue(int x,int y,LinkQueue &Robot,QNode *p); //把可以走的点加入到队列
int main()
{
	MAZH_SOLVE(7,7);
}

void MAZH_SOLVE(int endx,int endy)		//解决迷宫问题函数，参数为终点的坐标值
{
	 
	int dir;				//四个方向
	LinkQueue Robot;		//寻路机器人
	InitQueue(Robot);		//队列初始化
	
	Pos start;				//初始位置
	start.x = 1;
	start.y = 1;
	QElemType temp;
		
	
	printf("寻路开始...");
	InsertQueue(Robot,start);		//(1,1)入队	 
	QueuePtr tempPoint = Robot.front->next ;	
	printf("\nstart入队...");
	MAP[1][1] = 2;					//（1,1）标记为已走过										
	while(1)
	{		 
		temp = tempPoint->data;		//一个个取队列中元素，进行发散探索
		if(temp.x == endx && temp.y == endy)
		{			 
			printf("\n\n搞定！");
			break;					//找到到终点的路径了！完成
		}			 
		printf("开始判断各个方向..");
		for( dir = 0;dir<4;dir++)
		{
			switch(dir)				//对取得的元素进行四个方向探索！壮大我们的影分身队伍！
			{
			case 0:	AddtoQueue(temp.x,temp.y - 1,Robot,tempPoint);break;
			case 1:	AddtoQueue(temp.x + 1,temp.y,Robot,tempPoint);break;
			case 2:	AddtoQueue(temp.x,temp.y + 1,Robot,tempPoint);break;
			case 3:	AddtoQueue(temp.x - 1,temp.y,Robot,tempPoint);break;
			default:break;
			}					 
		}
		tempPoint = tempPoint->next;//取下一个		
	}	 
	print(Robot,tempPoint);			//打印路径
	 
}
void AddtoQueue(int x,int y,LinkQueue &Robot,QNode *p)
{
	 
	Pos temp;
	temp.x = x,temp.y = y;
	if(  MAP[temp.x][temp.y] == 1)	//可以走的，走过的标记2喔！	
	{
		printf("\n加入队列..x = %d, y = %d",x,y);
		InsertQueue(Robot,temp);
		Robot.rear->pre = p;
		MAP[temp.x][temp.y] = 2;
	}	 
}
void print(LinkQueue Robot,QueuePtr EndPoint)		
{	
	printf("\n寻路完成...");	 
	QueuePtr temp = EndPoint;
	Pos start;
	start.x = start.y = 1;	 	 
	printf("\n路径节点如下：x = %d, y = %d",temp->data.x,temp->data.y);
	do
	{				
		temp = temp->pre;		 
		printf("\n路径节点如下：x = %d, y = %d",temp->data.x,temp->data.y);		 
	}while(temp->data.x != 1 || temp->data.y != 1);				
	printf("完成！");

}

其中几个头文件，我在之前的几篇文章中给出过。

下面是运行结果演示：

欢迎留言交流，谢谢！