Floyd最短路算法
----转自啊哈磊
暑假，小哼准备去一些城市旅游。有些城市之间有公路，有些城市之间则没有，如下图。为了节省经费以及方便计划旅程，小哼希望在出发之前知道任意两个城市之前的最短路程。
现在回到问题：如何求任意两点之间最短路径呢？通过之前的学习我们知道通过深度或广度优先搜索可以求出两点之间的最短路径。所以进行n2遍深度或广度优先搜索，即对每两个点都进行一次深度或广度优先搜索，便可以求得任意两点之间的最短路径。可是还有没有别的方法呢？
我们来想一想，根据我们以往的经验，如果要让任意两点（例如从顶点a点到顶点b）之间的路程变短，只能引入第三个点（顶点k），并通过这个顶点k中转即a->k->b，才可能缩短原来从顶点a点到顶点b的路程。那么这个中转的顶点k是1~n中的哪个点呢？甚至有时候不只通过一个点，而是经过两个点或者更多点中转会更短，即a->k1->k2b->或者a->k1->k2…->k->i…->b。比如上图中从4号城市到3号城市（4->3）的路程dist[4][3]原本是12。如果只通过1号城市中转（4->1->3），路程将缩短为11（dist[4][1]+dist[1][3]=5+6=11）。其实1号城市到3号城市也可以通过2号城市中转，使得1号到3号城市的路程缩短为5（dist[1][2]+dist[2][3]=2+3=5）。所以如果同时经过1号和2号两个城市中转的话，从4号城市到3号城市的路程会进一步缩短为10。通过这个的例子，我们发现每个顶点都有可能使得另外两个顶点之间的路程变短。好，下面我们将这个问题一般化。
当任意两点之间不允许经过第三个点时，这些城市之间最短路程就是初始路程，如下。
假如现在只允许经过1号顶点，求任意两点之间的最短路程，应该如何求呢？只需判断dist[i][1]+dist[1][j]是否比dist[i][j]要小即可。dist[i][j]表示的是从i号顶点到j号顶点之间的路程。dist[i][1]+dist[1][j]表示的是从i号顶点先到1号顶点，再从1号顶点到j号顶点的路程之和。其中i是1~n循环，j也是1~n循环，代码实现如下。
1 for(i=1;i<=n;i++)2 {3 for(j=1;j<=n;j++)4 {5 if ( dist[i][j] > dist[i][1]+dist[1][j] )6 dist[i][j] = dist[i][1]+dist[1][j];7 }8 } 在只允许经过1号顶点的情况下，任意两点之间的最短路程更新为：
通过上图我们发现：在只通过1号顶点中转的情况下，3号顶点到2号顶点（dist[3][2]）、4号顶点到2号顶点（dist[4][2]）以及4号顶点到3号顶点（dist[4][3]）的路程都变短了。
接下来继续求在只允许经过1和2号两个顶点的情况下任意两点之间的最短路程。如何做呢？我们需要在只允许经过1号顶点时任意两点的最短路程的结果下，再判断如果经过2号顶点是否可以使得i号顶点到j号顶点之间的路程变得更短。即判断dist[i][2]+dist[2][j]是否比dist[i][j]要小，代码实现为如下。
1 //经过1号顶点2 for(i=1;i<=n;i++)3 for(j=1;j<=n;j++)4 if (dist[i][j] > dist[i][1]+dist[1][j]) dist[i][j]=dist[i][1]+dist[1][j];5 6 //经过2号顶点7 for(i=1;i<=n;i++)8 for(j=1;j<=n;j++)9 if (dist[i][j] > dist[i][2]+dist[2][j]) dist[i][j]=dist[i][2]+dist[2][j];
在只允许经过1和2号顶点的情况下，任意两点之间的最短路程更新为：
同理，继续在只允许经过1、2和3号顶点进行中转的情况下，求任意两点之间的最短路程。任意两点之间的最短路程更新为：
最后允许通过所有顶点作为中转，任意两点之间最终的最短路程为：
整个算法过程虽然说起来很麻烦，但是代码实现却非常简单，核心代码只有五行：
1 for(k=1;k<=n;k++)2 for(i=1;i<=n;i++)3 for(j=1;j<=n;j++)4 if(dist[i][j]>dist[i][k]+dist[k][j])5 dist[i][j]=dist[i][k]+dist[k][j];
这段代码的基本思想就是：最开始只允许经过1号顶点进行中转，接下来只允许经过1和2号顶点进行中转……允许经过1~n号所有顶点进行中转，求任意两点之间的最短路程。用一句话概括就是：从i号顶点到j号顶点只经过前k号点的最短路程。其实这是一种“动态规划”的思想，关于这个思想我们将在《啊哈！算法2——伟大思维闪耀时》在做详细的讨论。下面给出这个算法的完整代码。
代码：
/*Author:MengmengTime:2016-6-29 23:53:47Description:Floyd-Warshall算法求最短路径。*/#includeusing namespace std;int main(void){ int dist[10][10];//两点之间的距离数组；dist[1][2]表示顶点1到顶点2之间的距离 int inf = 99999999;//用inf(infinity的缩写)存储一个我们认为的正无穷值 int peak_num;//顶点个数 int initPath_num;//初始路径的数量 int p1, p2;//顶点p1,p2 int D;//p1->p2的距离 cout << "读入顶点数peak_num="; cin >> peak_num; cout << endl; cout << "初始路径数initPath_num="; cin >> initPath_num; cout << endl; //初始化：本顶点到本顶点路程为0；本顶点到其它顶点为无限大 for (int i = 1; i <= peak_num; i++) { for (int j = 1; j <= peak_num; j++) { if (i == j) dist[i][j] = 0; else dist[i][j] = inf; } } //读入初始路径的路程；格式：顶点p1->p2的距离为D cout << "读入初始路径的路程，格式：p1 p2 D" << endl; for (int i = 1; i <= initPath_num; i++) { cin >> p1 >> p2 >> D; dist[p1][p2] = D; } //输出原始的路程 cout << "原始的路程如下：" << endl; for (int i = 1; i <= peak_num; i++) { cout << endl; for (int j = 1; j <= peak_num; j++) { if (dist[i][j]==inf) cout << "∞" << " "; else cout << dist[i][j] << " "; } cout << endl; } //Floyd-Warshall算法核心语句 for (int k = 1; k <= peak_num;k++) for (int i = 1; i <= peak_num;i++) for (int j = 1; j <= peak_num;j++) if (dist[i][j] > dist[i][k] + dist[k][j]) dist[i][j] = dist[i][k] + dist[k][j]; //输出最终的结果 cout << "Floyd-Warshall算法得到的最短路程如下：" << endl; for (int i = 1; i <= peak_num; i++) { for (int j = 1; j <= peak_num; j++) { cout << dist[i][j] << " "; } cout << endl; }}
上面代码的输入数据样式为：
4 8 //顶点数 初始路径数1 2 2 //顶点a 顶点b 距离 下同 1 3 61 4 42 3 33 1 73 4 14 1 54 3 12
用下图来表示最终结果更直观一些，
通过这种方法我们可以求出任意两个点之间最短路径。它的时间复杂度是O(N3)。令人很震撼的是它竟然只有五行代码，实现起来非常容易。正是因为它实现起来非常容易，如果时间复杂度要求不高，使用Floyd-Warshall来求指定两点之间的最短路或者指定一个点到其余各个顶点的最短路径也是可行的。当然也有更快的算法，请看下一节：Dijkstra算法。
另外需要注意的是：Floyd-Warshall算法不能解决带有“负权回路”（或者叫“负权环”）的图，因为带有“负权回路”的图没有最短路。例如下面这个图就不存在1号顶点到3号顶点的最短路径。因为1->2->3->1->2->3->…->1->2->3这样路径中，每绕一次1->-2>3这样的环，最短路就会减少1，永远找不到最短路。其实如果一个图中带有“负权回路”那么这个图则没有最短路。
此算法由Robert W. Floyd（罗伯特·弗洛伊德）于1962年发表在“Communications of the ACM”上。同年Stephen Warshall（史蒂芬·沃舍尔）也独立发表了这个算法。Robert W．Floyd这个牛人是朵奇葩，他原本在芝加哥大学读的文学，但是因为当时美国经济不太景气，找工作比较困难，无奈之下到西屋电气公司当了一名计算机操作员，在IBM650机房值夜班，并由此开始了他的计算机生涯。此外他还和J.W.J. Williams（威廉姆斯）于1964年共同发明了著名的堆排序算法HEAPSORT。堆排序算法我们将在第七章学习。Robert W．Floyd在1978年获得了图灵奖。