3148: 搜索基础之迷宫问题

题目描述

定义一个二维数组： 

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表示可以走的路，只能横着走或竖着走，不能斜着走，要求编程序找出从左上角到右下角的最短路线。 
 

输入

一个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

样例输出

(0, 0)
(1, 0)
(2, 0)
(2, 1)
(2, 2)
(2, 3)
(2, 4)
(3, 4)
(4, 4)

#include<iostream>
#include<algorithm>
#include<queue>
#include<cstdio>
#include<cstdlib>
#include<cstring>
using namespace std;
struct NODE
{
    int x;
    int y;
    int pre;
}b[110];
int a[10][10];
int dx[]={0,-1,0,1};
int dy[]={1,0,-1,0};
void out(int t)
{
    int s[100];
    int top=0;
    s[0]=t;
    while(b[s[top]].pre!=-1)
    {
        top++;
        s[top]=b[s[top-1]].pre;
    }
    while(top>=0)
    {
        printf("(%d, %d)\n",b[s[top]].x-1,b[s[top]].y-1);
        top--;
    }
}
void bfs()
{
    int head=0;
    int rear=0;
    while(head<=rear)
    {
        if(b[head].x==5&&b[head].y==5)
        {
            out(head);
            return;
        }
        for(int i=0;i<4;i++)
        {
            int nx=b[head].x+dx[i];
            int ny=b[head].y+dy[i];
            if(nx>0&&nx<=5&&ny>0&&ny<=5&&a[nx][ny]==0)
            {
                a[nx][ny]=1;
                rear++;
                b[rear].x=nx;
                b[rear].y=ny;
                b[rear].pre=head;
            }
        }
        head++;
    }
}
int main()
{
    for(int i=1;i<=5;i++)
    {
        for(int j=1;j<=5;j++)
        {
            scanf("%d",&a[i][j]);
        }
    }
    b[0].x=1;
    b[0].y=1;
    b[0].pre=-1;
    bfs();
    return 0;
}