迷宫问题 输出路径

定义一个二维数组：

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)

#include<stdio.h>
bool vis[6][6];
int b[6][6];
struct node {
   
	int x;
	int y;
	int pre;
};
struct node que[20];
int way[4][2]={
   0,1,0,-1,1,0,-1,0};
void print(struct node a)
{
   
	if(a.pre==-1)
	printf("(%d, %d)\n",a.x,a.y);
	else
	{
   
		print(que[a.pre]);//递归
		printf("(%d, %d)\n",a.x,a.y);
	}
}
int main()
{
   
	int i,j;
	int tail=0,head=0;
	for(i=0;i<=4;i++)
	for(j=0;j<=4;j++)
	scanf("%d",&b[i][j]);
	vis[0][0]=1;
	que[0].x=0;
	que[0].y=0;
	que[0].pre=-1;
	tail++;
	while(head<tail)
	{
   
		int tx,ty;
		int flag=0;
		for(int k=0;k<=3;k++)
		{
   
			tx=que[head].x+way[k][0];
			ty=que[head].y+way[k][1];
			if(tx<0||ty<0||tx>=5||ty>=5)
			continue;
			if(vis[tx][ty]==0&&b[tx][ty]==0)
			{
   
				que[tail].x=tx;
				que[tail].y=ty;
				que[tail].pre=head;
				tail++;
			}
			if(tx==4&&ty==4)
			{
   flag=1;//一定要定义一个flag.否则会出现runtime error。。
			break;
			}
			
		 }
		 if(flag)
		 {
   
		 		print(que[tail-1]);
		 		break;
		 }
		  head++; 
	}
	
}