迷宫问题 模拟队列 广度优先搜索

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 <cstdio>

#include <cmath>

#include <cstring>

#include <ctime>

#include <iostream>

#include <algorithm>

#include <set>

#include <vector>

#include <sstream>

#include <queue>

#include <typeinfo>

#include <fstream>

typedef long long ll;

using namespace std;

//freopen("D.in","r",stdin);

//freopen("D.out","w",stdout);

#define sspeed ios_base::sync_with_stdio(0);cin.tie(0)

#define maxn 100

const int inf=0x7fffffff;   //无限大

struct dota

{

    int x;

    int y;

    int pre;

} haha[1000];

int dx[4]={1,-1,0,0};

int dy[4]={0,0,1,-1};

//int dp[10][10];

int vis[50][50];

void print(int x)

{

    if(haha[x].pre!=-1)

    {

        print(haha[x].pre);

        printf("(%d, %d)\n",haha[x].x,haha[x].y);

    }

}

void bfs(int x,int y)

{

    haha[0].x=x;

    haha[0].y=y;

    haha[0].pre=-1;

    int start=0;

    int fina=1;

    int m=1;

    while(start<fina)

    {

        for(int i=0;i<4;i++)

        {

            int a=haha[start].x+dx[i];

            int b=haha[start].y+dy[i];

            if(a<0||a>4)

                continue;

            if(b<0||b>4)

                continue;

            if(vis[a][b]==1)

                continue;

            fina++;

            vis[a][b]=1;

            haha[m].x=a;

            haha[m].y=b;

            haha[m++].pre=start;

            if(a==4&&b==4)

            {

                print(start);

            }

        }

        start++;

    }

}

int main()

{

    for(int i=0;i<5;i++)

        for(int j=0;j<5;j++)

            {

                cin>>vis[i][j];

            }

    printf("(0, 0)\n");

    bfs(0,0);

    printf("(4, 4)\n");

    return 0;

}