迷宫问题

G - 迷宫问题
Time Limit:1000MS     Memory Limit:65536KB     64bit IO Format:%lld & %llu
Submit Status Practice POJ 3984
Description
定义一个二维数组： 
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 00 1 0 1 00 0 0 0 00 1 1 1 00 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>#include<string.h>struct maze{int x;int y;int s;int f;}que[30];void print(int i){if(que[i].f!=0){print(que[i].f);printf("(%d, %d)\n",que[i].x,que[i].y);}}//回溯寻找路径int main(){int maze[6][6],book[6][6];int next[4][2]={{0,1},{1,0},{0,-1},{-1,0}};int head,tail,flag=0,tx,ty,k=0;int i,j;memset(book,0,sizeof(book));for(i=0;i<5;i++){for(j=0;j<5;j++)scanf("%d",&maze[i][j]);}head=1;tail=1;book[0][0]=1;que[tail].x=0;que[tail].y=0;que[tail].s=0;que[tail].f=0;//将左上角的数值入队tail++;while(head<tail){for(k=0;k<4;k++){tx=que[head].x+next[k][0];ty=que[head].y+next[k][1];if(tx<0||ty<0||tx>4||ty>4)continue;//越界跳到上一步if(maze[tx][ty]==0&&book[tx][ty]==0)//该点未走过并且通{book[tx][ty]=1;//标记已走过que[tail].x=tx;que[tail].y=ty;//入队que[tail].f=head;tail++;que[tail].s=que[tail].s+1;    }    if(tx==4&&ty==4)//到达右下角    {    printf("(0, 0)\n");    print(head);    }}head++;//未到达右下角，队首出对}printf("(4, 4)\n");return 0;