假设有如上的迷宫,我们模拟下是如何记录了最短路径的,我们从(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;
}