最短路径 Floyd算法

// path数组存p到q的最短路径最后是经过哪一点
// path数组初始值为0

// dist数组存两两之间的距离，这个代码是按照如果p->q没有直接的路径,那么他
// 们之间的值为0,需要用 其他的点进行更新
// vertex 顶点数
// line数组存着从p到q所要经过的点，用递归写，首先起点是p,然后判断path[p][q]是否大于0

// 大于0代表p->q之间还经过了其他点，

// 那么要继续判断p到path[p][q]之间还有没有经过其他点，如果
// 没有那么// 等于0，就是p->path[p][q]，接着继续判断path[p][q]到q之间有没有经过其他点,有的话继续递归，

// 否则p->q的路径就是p->path[p][q]->q
//
// 给出测试数据
7
0 20 50 30 0 0 0
20 0 25 0 0 70 0
50 25 0 40 25 50 0
30 0 40 0 55 0 0
0 0 25 55 0 10 70
0 70 50 0 10 0 50
0 0 0 0 70 50 0

//下面的这句system("pause"); 分开每次输出p->q的距离，

 

#include<iostream> #define Maxm 501 using namespace std; int p,q,k,m; int Vertex,Line[Maxm]; int Path[Maxm][Maxm],Dist[Maxm][Maxm]; void Root(int p,int q) { if(Path[p][q]>0) { Root(p,Path[p][q]); Root(Path[p][q],q); } else { Line[k]=q; k++; } } int main() { memset(Path,0,sizeof(Path)); memset(Dist,0,sizeof(Dist)); cin >> Vertex; for(p=1;p<=Vertex;p++) for(q=1;q<=Vertex;q++) cin >> Dist[p][q]; for(k=1;k<=Vertex;k++) for(p=1;p<=Vertex;p++) if(Dist[p][k]>0) for(q=1;q<=Vertex;q++) if(Dist[k][q]>0) { if(((Dist[p][q]>Dist[p][k]+Dist[k][q])||(Dist[p][q]==0))&&(p!=q)) { Dist[p][q]=Dist[p][k]+Dist[k][q]; Path[p][q]=k; } } for(p=1;p<=Vertex;p++) { for(q=p+1;q<=Vertex;q++) { cout << "/n==========================/n"; cout << "Source:" << p << '/n' << "Target " << q << '/n'; cout << "Distance:" << Dist[p][q] << '/n'; cout << "Path:" << p; k=2; Root(p,q); for(m=2;m<=k-1;m++) cout << "-->" << Line[m]; cout << '/n'; cout << "==========================/n"; } } return 0; }