POJ3984BFS记录路径

定义一个二维数组： 

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>  
#include<string.h>  
#include<stdlib.h>  
#include<iostream>
using namespace std;
struct point
{
    int x;
    int y;
}list[100];
int map[5][5];
int vis[5][5];
int pre[101];
int u[4][2]={1,0,-1,0,0,1,0,-1};
void print(int t)
{
    int x=pre[t];
    if(x==0)
    {
        printf("(0, 0)
");
        printf("(%d, %d)
",list[t].x,list[t].y);
    }
    else
    {
        print(x);
        printf("(%d, %d)
",list[t].x,list[t].y);
    }
}
void bfs(int x1,int y1)
{
    int head,next,i;
    memset(vis,0,sizeof(vis));
    list[0].x=x1;
    list[0].y=y1;
    pre[0]=-1;
    head=0;
    next=1;
    while(head<next)
    {
        int x=list[head].x;
        int y=list[head].y;
        if(x==4&&y==4)
        {
            print(head);
            return ;
        }
        for(int i=0;i<4;i++)
        {
            int tx=list[head].x+u[i][0];
            int ty=list[head].y+u[i][1];
            if(tx>=0&&tx<5&&ty>=0&&ty<5&&map[tx][ty]==0&&vis[tx][ty]==0)
            {
                vis[tx][ty]=1;
                list[next].x=tx;
                list[next].y=ty;
                pre[next]=head;
                next++;
            }
        }
        head++;
    }
}
int main()  
{  
    for(int i=0;i<5;i++)
    for(int j=0;j<5;j++)
    cin>>map[i][j];
    bfs(0,0);
    return 0;
}