poj 迷宫问题（路径记录）（DFS,BFS）

迷宫问题

原题链接：http://poj.org/problem?id=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 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)

代码1（DFS）：

#include<stdio.h>
#include<string.h>
#include<stack>
#define INF 0x3f3f3f3f
using namespace std;
int a[5][5],ans=INF,k;
struct node
{
    int x,y;
} b[100];
void mycopy(stack<node> a)//路径反转
{
    for(k=0; !a.empty(); k++)
    {
        b[k]=a.top();
        a.pop();
    }
}
int to[4][2]= {0,1,0,-1,1,0,-1,0};
stack<node>s;//存储路径
void dfs(int x,int y,int step)
{
    node now;
    now.x=x,now.y=y;
    s.push(now);
    if(x==4&&y==4)
    {
        if(step<ans)//找寻最短路径
        {
            ans=step;
            mycopy(s);
        }
    }
    for(int i=0; i<4; i++)
    {
        int m=now.x+to[i][0],n=now.y+to[i][1];
        if(m>=0&&m<5&&n>=0&&n<5&&!a[m][n])
        {
            a[m][n]=1;
            dfs(m,n,step+1);
            a[m][n]=0;//还原
        }
    }
    s.pop();
}
int main()
{
    int i,j;
    for(i=0; i<5; i++)
        for(j=0; j<5; j++)
            scanf("%d",&a[i][j]);
    dfs(0,0,0);
    for(i=k-1; i>=0; i--)//输出
        printf("(%d, %d)\n",b[i].x,b[i].y);
    return 0;
}

代码2（BFS）：

#include<stdio.h>
int a[5][5],head=0,tail=1;
struct node
{
    int x,y,front;//front记录每一步的位置
} b[100];
void print(int i)
{
    if(b[i].front!=-1)
    {
        print(b[i].front);
        printf("(%d, %d)\n",b[i].x,b[i].y);
    }
}
int to[4][2]= {0,1,0,-1,1,0,-1,0};
void bfs(int x,int y)
{
    b[head].x=x,b[head].y=y;
    b[head].front=-1;
    a[x][y]=1;
    while(head<tail)
    {
        for(int i=0; i<4; i++)
        {
            int m=b[head].x+to[i][0],n=b[head].y+to[i][1];
            if(m>=0&&m<5&&n>=0&&n<5&&!a[m][n])
            {
                a[m][n]=1;
                b[tail].x=m;
                b[tail].y=n;
                b[tail].front=head;//记录当前位置的上一步是哪个位置
                tail++;
            }
            if(m==4&&n==4)
                print(head);
        }
        head++;
    }
}
int main()
{
    int i,j;
    for(i=0; i<5; i++)
        for(j=0; j<5; j++)
            scanf("%d",&a[i][j]);
    printf("(0, 0)\n");
    bfs(0,0);
    printf("(4, 4)\n");
    return 0;
}

ps：BFS主要是给每一步都做上一个位置标记，让每一步都记录上一步的位置，也就是记录这一步是从哪一步过来的