题意:给出的矩阵0可以走,1不可以走,求(0,0)到(4,4)的最短路,并输出一条最短路径。
思路:用BFS求最短路,同时各个点的前驱节点,也就保存了路径,最后DFS从(4,4)搜回去,就可以输出路径了。
#include<iostream>
using namespace std;
struct point
{
int x,y;
int pre_x,pre_y;//图上的点及其前驱节点
}node[5][5];//要保存路径所以定义了数组
int map[5][5];
int dx[4]={-1,0,1,0};
int dy[4]={0,1,0,-1};
point p[30];
int bfs()
{
point start;
int front=0,rear=0;
int tx,ty;
start.x=0;start.y=0;
start.pre_x=-1;start.pre_y=-1;
node[0][0]=start;
map[0][0]=1;//各种初始化
p[rear++]=start;//初始化队列
while(front!=rear)
{
start=p[front++];
for(int i=0;i<4;i++)
{
tx=start.x+dx[i];
ty=start.y+dy[i];
if(!map[tx][ty]&&tx>=0&&tx<5&&ty>=0&&ty<5)
{
map[tx][ty]=1;
node[tx][ty].pre_x=start.x;//tx,ty的前驱节点是start.x,start.y
node[tx][ty].pre_y=start.y;
node[tx][ty].x=tx;
node[tx][ty].y=ty;
p[rear++]=node[tx][ty];
if(tx==4&&ty==4) return 0;
}
}
}
return 0;
}
int dfs(int x,int y)
{
int pre_x=node[x][y].pre_x;
int pre_y=node[x][y].pre_y;
if(pre_x!=-1&&pre_y!=-1)//递归出口,搜到了(0,0)点
dfs(pre_x,pre_y);
printf("(%d, %d)\n",x,y);
return 0;
}
int main()
{
for(int i=0;i<5;i++)
for(int j=0;j<5;j++)
cin>>map[i][j];
bfs();
dfs(4,4);
system("pause");
}