BFS-POJ-3984-迷宫问题

迷宫问题
Time Limit: 1000MS Memory Limit: 65536K
Total Submissions: 11333 Accepted: 6784
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)

水题，BFS保存路径即可。

//
//  main.cpp
//  简单搜索-K-迷宫问题
//
//  Created by 袁子涵 on 15/8/9.
//  Copyright (c) 2015年 袁子涵. All rights reserved.
//

#include <iostream>
#include <string.h>
#include <stdio.h>

using namespace std;

bool maze[6][6];
bool visit[6][6];

typedef struct node
{
    int x,y;
    struct node *pre;
}Node;

typedef struct queue
{
    int head,tail;
    Node data[50];
}Queue;

Queue q;
Node final,out[50];

void init_queue()
{
    q.head=0;
    q.tail=0;
}

bool empty_queue()
{
    if (q.head==q.tail) {
        return 0;
    }
    return 1;
}

void bfs()
{
    Node t;
    q.data[0].x=0;
    q.data[0].y=0;
    visit[0][0]=1;
    q.tail++;
    while (empty_queue()) {
        t=q.data[q.head];
        //判断是否到终点
        if (t.x==4 && t.y==4) {
            final=q.data[q.head];
            return;
        }
        //上下左右
        if (t.x>0 && visit[t.x-1][t.y]==0 && maze[t.x-1][t.y]==0) {
            q.data[q.tail].x=t.x-1;
            q.data[q.tail].y=t.y;
            q.data[q.tail].pre=&q.data[q.head];
            q.tail++;
            visit[t.x-1][t.y]=1;
        }
        if (t.x<4 && visit[t.x+1][t.y]==0 && maze[t.x+1][t.y]==0) {
            q.data[q.tail].x=t.x+1;
            q.data[q.tail].y=t.y;
            q.data[q.tail].pre=&q.data[q.head];
            q.tail++;
            visit[t.x+1][t.y]=1;
        }
        if (t.y>0 && visit[t.x][t.y-1]==0 && maze[t.x][t.y-1]==0) {
            q.data[q.tail].x=t.x;
            q.data[q.tail].y=t.y-1;
            q.data[q.tail].pre=&q.data[q.head];
            q.tail++;
            visit[t.x][t.y-1]=1;
        }
        if (t.y<4 && visit[t.x][t.y+1]==0 && maze[t.x][t.y+1]==0) {
            q.data[q.tail].x=t.x;
            q.data[q.tail].y=t.y+1;
            q.data[q.tail].pre=&q.data[q.head];
            q.tail++;
            visit[t.x][t.y+1]=1;
        }
        q.head++;
    }
}

int main(int argc, const char * argv[]) {
    Node *p1,*p2;
    for (int i=0; i<5; i++) {
        for (int j=0; j<5; j++) {
            cin >> maze[i][j];
        }
    }
    bfs();
    p1=&final;
    int t=0;
    while (p1!=NULL) {
        p2=p1->pre;
        out[t].x=p1->x;
        out[t].y=p1->y;
        t++;
        p1=p2;
    }
    while (t--) {
        printf("(%d, %d)\n",out[t].x,out[t].y);
    }
    return 0;
}