迷宫问题

迷宫问题

Time Limit: 1000MS		Memory Limit: 65536K
Total Submissions: 24661		Accepted: 14402

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遍历然后记录下所走过的路.

#include <iostream>
#include <cstring>
#include <cstdio>
#include <algorithm>
#include <queue>
#include <stack>
#define N 105
#define inf 1000000000
using namespace std;
int dir[4][2]={{1,0},{-1,0},{0,1},{0,-1}};
typedef pair<int,int> P;
queue<P> q;
stack<P> s;
P fa[5][5];
int k[5][5];
int vis[5][5];
int bfs(){
  for(int i=0;i<5;i++)
    for(int j=0;j<5;j++)
      vis[i][j]=inf;
  q.push(P(0,0));
  vis[0][0]=1;
  while(q.size()){
    P r=q.front();q.pop();
    if(r.first==4&&r.second==4){
      break;
    }
    for(int i=0;i<4;i++){
      int xx=r.first+dir[i][0];
      int yy=r.second+dir[i][1];
      if(xx>=0&&xx<=4&&yy>=0&&yy<=4&&k[xx][yy]==0&&vis[xx][yy]==inf){
        q.push(P(xx,yy));
        vis[xx][yy]=1;
        fa[xx][yy]=r;
    }
  }
 }
}

int main(){
  for(int i=0;i<5;i++)
    for(int j=0;j<5;j++)
      cin>>k[i][j];
  bfs();
  int x,y;
  x=y=4;
  s.push(P(4,4));
  while(x!=0||y!=0){
    P p=fa[x][y];
    s.push(p);
    x=p.first;
    y=p.second;
  }
  while(s.size()){
    P p=s.top();
    s.pop();
    cout<<"("<<p.first<<", "<<p.second<<")"<<endl;;
  }
  return 0;
}