迷宫问题

定义一个二维数组：

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;
}