YTU 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

样例输出

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

 

#include<stdio.h>
int map[5][5];
int m[4]={1,0,-1,0};
int n[4]={0,1,0,-1};
typedef struct
{
    int x,y;
}Node;
Node queue[50];
Node s[5][5];
void bfs()
{
    int i;
    int k=0,t=1;
    Node a;
    a.x=a.y=0;
    queue[0]=a;
    map[0][0]=1;
    while(k<t)
    {
        a=queue[k];//取队首点进行搜索
        k++;
        for(i=0;i<4;i++)
    {
        if(map[a.x+m[i]][a.y+n[i]]==0&&a.x+m[i]>=0&&a.x+m[i]<5&&a.y+n[i]>=0&&a.y+n[i]<5)
        {
            s[a.x+m[i]][a.y+n[i]]=a;//记录要搜索点的前一个点位置
            if(a.x+m[i]==4&&a.y+n[i]==4)
            return;//如果搜索点的相邻点中有出口点，则结束程序
            else
            {
                map[a.x+m[i]][a.y+n[i]]=1;//反之，使搜索点为1，防止反复搜索
                queue[t].x=a.x+m[i];//使相邻点入队，进行搜索
                queue[t].y=a.y+n[i];
                t++;
            }
        }
    }
}
    }
int main()
{
    int i,j,b,d;
    for(i=0;i<5;i++)
        for(j=0;j<5;j++)
        scanf("%d",&map[i][j]);
        bfs();
        int k=0;
        queue[k].x=4;
        queue[k].y=4;
        k++;
        i=j=4;
        while(i!=0||j!=0)//通过出口点和bfs（）中对点的记录倒推出路径并使其入队
        {
            b=i;
            d=j;
            i=s[b][d].x;
            j=s[b][d].y;
            queue[k].x=i;
            queue[k].y=j;
            k++;
        }
        for(i=k-1;i>=0;i--)
            printf("(%d, %d)\n",queue[i].x,queue[i].y);
        return 0;
}