迷宫问题---广搜

定义一个二维数组： 

int maze[5][5] = {

    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,

};

它表示一个迷宫，其中的1表示墙壁，0表示可以走的路，只能横着走或竖着走，不能斜着走，要求编程序找出从左上角到右下角的最短路线。

Input

一个5 × 5的二维数组，表示一个迷宫。数据保证有唯一解。

Output

左上角到右下角的最短路径，格式如样例所示。

Sample Input

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
Sample Output

(0, 0)
(1, 0)
(2, 0)
(2, 1)
(2, 2)
(2, 3)
(2, 4)
(3, 4)
(4, 4)
--------------------- 
作者：搬砖的小孩有肉吃 
来源：CSDN 
原文：https://blog.csdn.net/qq_43746332/article/details/89743717 
版权声明：本文为博主原创文章，转载请附上博文链接！

#include<stdio.h>

struct node{   //一个队列，记录路径；
	int x;
	int y;
	int f;   //记录每一个分支的父节点的队列下标；
	int step;  //记录步数；
}queue[26]; 

int head=0,tail=0,a[5][5],book[5][5];

void function(int tail)   //参数是队尾；
{
	if(queue[tail].f==0){  //如果队尾的父节点是0；打印并回溯；
		printf("(%d, %d)\n",queue[queue[tail].f].x,queue[queue[tail].f].y);
		return;  //返回上一次调用function的地方；
		}
	else function(queue[tail].f);  //如果队尾的父节点不是0；就将该父节点作为新的队尾继续调用；
    //这是每次回溯要执行的部分
	printf("(%d, %d)\n",queue[queue[tail].f].x,queue[queue[tail].f].y); 
}   //注意，因起初参数是队尾，所以此函数打印不了目标坐标，只能打印到目标坐标的父节点坐标；

int main(){
	for(int i=0;i<5;i++)
	for(int j=0;j<5;j++)
	scanf("%d",&a[i][j]);
	queue[0].x=0;  //先把第一个点压进队列；
	queue[0].y=0;
	queue[0].step=0;
     tail++;    //然后接着用tail扩展队列；
	int flag=0;  //flag标记有没有到达目标；
	int next[4][2]={{0,1},{1,0},{0,-1},{-1,0}};
	while(head<tail){
	for(int k=0;k<4;k++){
		int tx=queue[head].x+next[k][0];  //寻点；顺时针：右下左上；
		int ty=queue[head].y+next[k][1];
		if(book[tx][ty]==1||tx<0||tx>4||ty<0||ty>4||a[tx][ty]==1)
		continue;     //判断是否越界，是否重走，是否有障碍物；
		book[tx][ty]=1;   //标记为走过；
		queue[tail].x=tx;  //把该点压入队列；
		queue[tail].y=ty;
		queue[tail].f=head;  //记录该点的父亲；
		queue[tail].step=queue[head].step+1;   //走到该点是其父节点的步数加一；
		tail++;    //接着扩展队列
		if(tx==4&&ty==4)  //判断是否到达目的地；
		{
			flag=1;
			break;
		}
	}
	if(flag==1)
	break;
	head++;   //对一个点的所有扩展完成后，将该点出列，即head++；
	}
    tail--;  //因为结束时tail指向了队尾的下一个元素；
	function(tail);   //打印路径；
	printf("(4, 4)\n");  //最后把目标坐标打印，原因看function函数；
	return 0;
}