迷宫问题 POJ - 3984

假设有如上的迷宫，我们模拟下是如何记录了最短路径的，我们从（0，0）点出发，向周围扩展

只有（1，0），从（1，0）这个点再扩展到（2，0），（1，1）下次扩展只有（1，1）可以扩展，扩展到（1，2），从（1，2）就可扩展到（2，2）这时遍历完了，

int x=2,y=2;
while(x!=-1&&y!=-1){
 cout<<"x:"<<x<<" y:"<<y<<endl;
int tx=x,ty=y;
 x=map[tx][ty].x;
 y=map[tx][ty].y;

}

#include <iostream>
#include <cstring>
#include <cstdio>
#include <queue>
#include <stack>
using namespace std;
const int N =5;
int g[N][N];
typedef  pair<int,int> PII;
struct node{
  int x,y;
};
node map[N][N];
bool st[N][N];
int tx[]={0,1,0,-1};
int ty[]={1,0,-1,0};
void bfs(){
  queue<node>q;
  node t={0,0};
  q.push(t);
  st[0][0]=true;
  node tt={-1,-1};
  map[0][0]=tt;
  while(q.size()){
    node temp=q.front();
    q.pop();
    if(temp.x==4&&temp.y==4)return ;
    for(int i=0;i<4;i++){
      int nx=temp.x+tx[i],ny=temp.y+ty[i];
      if(nx>=0&&nx<5&&ny>=0&&ny<5&&!st[nx][ny]&&g[nx][ny]!=1){
          st[nx][ny]=true;
          node k={nx,ny};
          map[nx][ny]=temp;
          q.push(k);
      }
    }
  }
}
int main(){
  for(int i=0;i<5;i++)
    for(int j=0;j<5;j++)
       cin>>g[i][j];
       bfs();
       stack< PII >qq;
       int x=4,y=4;
       while(x!=-1&&y!=-1){
         pair<int,int >k;
         k.first=x;
         k.second=y;
         qq.push(k);
         int tx=x,ty=y;
         x=map[tx][ty].x;
         y=map[tx][ty].y;
       }
       while(qq.size()){
         PII k=qq.top();
         qq.pop();
         cout<<"("<<k.first<<", "<<k.second<<")"<<endl;
       }
  return 0;
}