题解:简单的BFS问题,寻找最短路使用BFS
tips:打印路径从终点开始找路,每次保存父节点,则从起点可以打印路径
#include <stdio.h>
#include <iostream>
using namespace std;
bool visi[5][5];
int matrix[5][5],fa[5][5];
int position[4][2]={{0,1},{1,0},{0,-1},{-1,0}};
int position2[4][2]={{0,-1},{-1,0},{0,1},{1,0}};
bool bfs(int x,int y){
if(x==0&&y==0)return true;
for(int i=0;i<4;i++){//四个方向
if(x+position[i][0]<5&&x+position[i][0]>=0&&y+position[i][1]<5&&y+position[i][1]>=0&&visi[x+position[i][0]][y+position[i][1]]&&matrix[x+position[i][0]][y+position[i][1]]==0){
visi[x+position[i][0]][y+position[i][1]]=false;
fa[x+position[i][0]][y+position[i][1]]=i;//保存父节点
if(bfs(x+position[i][0], y+position[i][1]))return true;
}
}
return false;
}
int main(){
for(int i=0;i<5;i++){
for(int j=0;j<5;j++){
cin>>matrix[i][j];
visi[i][j]=true;
fa[i][j]=-1;
}
}
bfs(4, 4);//从终点开始找路径
int t=fa[0][0];//从起点开始打印父节点路径
fa[4][4]=-1;
int x=0,y=0;
cout<<"("<<x<<", "<<y<<")"<<endl;
while(t!=-1){
cout<<"("<<x+position2[t][0]<<", "<<y+position2[t][1]<<")"<<endl;
x=x+position2[t][0];
y=y+position2[t][1];
t=fa[x][y];
}
}