迷宫问题

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 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<iostream>  
    #include<string.h>
    using namespace std;  
    int a[101][101],flag;  
    int next[4][2]={{0,1},
				{1,0},
				{0,-1},
				{-1,0}};
    struct node{  
        int x,y,pre;  
    }q[101];  
    //打印出最短路径 
    void print(int i){  
        if(q[i].pre!=-1){  
            print(q[i].pre);  
            cout<<"("<<q[i].x<<","<<" "<<q[i].y<<")"<<endl;  
        }  
    }  
    void bfs(int x1,int y1){  
        int head=1,tail=1,tx,ty;  
        q[tail].x=x1;  
        q[tail].y=y1;   
        q[tail].pre=-1; 
		tail++; 
		flag=0;//用来标记是否到达目的地，0表示没有
        while(head<tail){  
            for(int i=0;i<4;i++){  
                tx=q[head].x+next[i][0];  
                ty=q[head].y+next[i][1];  
                if(tx<0||ty<0||tx>4||ty>4||a[tx][ty])  
                    continue;  
                else{  
                    a[tx][ty]=1;  
                    q[tail].x=tx;  
                    q[tail].y=ty;  
                    q[tail].pre=head;  
                    tail++;  
                }  
                if(tx==4&&ty==4) 
                {
                	flag=1;
                	print(head);  
                	break; 
                  } 
            }  
            if(flag==1)
            	break;
            head++;  
        }  
    }  
    int main(){  
        int i,j,k,tx,n;  
        for(i=0;i<5;i++)  
            for(j=0;j<5;j++)  
                cin>>a[i][j];  
        cout<<"(0, 0)"<<endl;  
        bfs(0,0);  
        cout<<"(4, 4)"<<endl;  
        return 0;  
    }