floyd最短路径算法2，求出经过哪些路径

#include<iostream>
#include<stdio.h>
#include<stdlib.h>
#include <string.h>
#include<algorithm>
using namespace std;

//最短路径算法 2
//数组的下标从0开始，但是算法下标从1开始，所以将数组0位的空着，方便理解。
int W[6][6];
int D[6][6];//最后的最短路径结果

int P[6][6];//从V_i到V_j最短路径上一个中间顶点的**最高**索引(若至少存在一个中间顶点)
//若不存在中间顶点则为0
void floyd(int n,int D[][6],int P[][6])
{
for(int k=1;k<=n;k++)
{
for(int i=1;i<=n;i++)
{
for(int j=1;j<=n;j++)
{
if(D[i][j]>D[i][k]+D[k][j])
{
D[i][j]=D[i][k]+D[k][j];
P[i][j]=k;//这个地方+1是因为下标的缘故
}

}
}
}
}

void path(int q,int r)
{
if(P[q][r]!=0)
{
path(q,P[q][r]);
cout<<"v"<<P[q][r];
//path(P[q][r],r);
}
}

int main()
{
int n=5;
cout<<"输入邻接矩阵"<<endl;
for(int i=1;i<=n;i++)
{
for(int j=1;j<=n;j++)
{
cin>>W[i][j];
}
}
memset(P,0,sizeof(int));
memcpy(D,W,sizeof(int)*36);
floyd(n,D,P);
for(int i=1;i<=n;i++)
{
for(int j=1;j<=n;j++)
{
cout<<D[i][j]<<" ";
}
cout<<endl;
}
cout<<endl;
for(int i=1;i<=n;i++)
{
for(int j=1;j<=n;j++)
{
cout<<P[i][j]<<" ";
}
cout<<endl;
}
cout<<endl;
path(5,3);
return 0;
}