迷宫问题

定义一个二维数组：

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>
struct node{
int x;
int y;
int f;    //用来记录此结点的父亲，即从哪一点扩展出来的
}que[30];  //定义一个结构体，que数组用来存放拓展出来的新点
int a[6][6];  //存放地图
int book[6][6];//记录被访问过的点
int main(){
int i,j;
for(i=0;i<5;i++){
for(j=0;j<5;j++)
scanf("%d",&a[i][j]);
}
int next[4][2]={{1,0},{0,1},{-1,0},{0,-1}};// 4种扩展方向
int head=0,tail=0;
int tx,ty;        //将起点加入到队列里
que[tail].x=0;
que[tail].y=0;
que[tail].f=0;
book[0][0]=1;    //标记已被访问
tail++;
// int cnt=1;
while(head<tail){
for(i=0;i<4;i++){
tx=que[head].x+next[i][0];
ty=que[head].y+next[i][1];
if(tx<0||ty>4||tx>4||ty<0)  //判断 新点是否越界
continue;
if(a[tx][ty]==0&&book[tx][ty]==0){ //判断 新点是否在路径上和是否可以通过
que[tail].x=tx;
que[tail].y=ty;
que[tail].f=head;   //记录新点是从哪一点扩展出来的
book[tx][ty]=1;
// printf("%d X : %d   Y : %d\n",cnt,tx,ty);
//  cnt++;
tail++;
if(tx==4&&ty==4) break;
}
}
if(tx==4&&ty==4) break;
head++;    //每完成一次扩展 继续下一次的扩展
}
// 寻找路径
int fa=que[tail-1].f;
int t[30]={0}; //记录最短路经上的点
t[fa]=1;
for(i=tail-1;i>=0;i--){
fa=que[fa].f;
t[fa]=1;
}
for(i=0;i<30;i++){
if(t[i]==1){
printf("(%d, %d)\n",que[i].x,que[i].y);
}
}
printf("(4, 4)\n");
return 0;
}