C++ 有向图最短路径之Dijkstra算法

一、思路

     1.Dijkstra算法

     每次都是从起始顶点v出发，找与v有关的有向边<v,u>。找到<v, u>之后，找有向边<u,k>,如果通过绕过顶点u而使从v到k的路径更短的话，就要修改v到k的路径。即v->u>k的路径比v->k的路径更短。

      

 如上面的有向图：起始顶点为0

     （1）先将顶点0加入到已访问集合s中，找第一条权值最小的邻接边为<0, 1>，权值为10。把顶点1加入到集合s中。

             然后找顶点1的邻接边 <1, 2>,权值为50。因为刚开始，没有从0到2的直接路径，所以此时要修改顶点0到顶点2的最短路径为：0->1->2 ，权值即为：10+50=60。顶点1的邻接边没有了，结束；

     （2）然后是权值次小的邻接有向边<0, 3>,权值为30。把顶点3加入到集合s中

             然后找顶点3的邻接边<3, 2>,权值为：20。路径： 0->3->2，权值为：30+20=50。该路径长度小于0->1->2的路径长度60，所以要修改0->2的最短路径为：0->3->2，长度为：50。

             接着，找另一邻接边为：<3, 4>,权值为：60。路径：0->3->4，长度为：30+60=90。该路径长度小于从0->4的路径长度，所以要修改从顶点0到顶点4的最短路径为：0->3->4，长度为90。

             顶点3没有邻接边了，结束；

     （3）因为顶点2还没被访问过，且权值是第3小，前面求得从顶点0到顶点2的最短路径为：0->3->2，长度为：50。

             接着从顶点2出发，把顶点2加入到集合s中（标记为已访问过），找顶点2的邻接边，找到为：<2, 4>，权值为：10。因为从0->3->2->4的路径长度：50+10=60小于0->3->4的路径长度90，所以要修改从顶点0到顶点4的最短路径为：0->3->2->4，长度为：60；顶点2没有邻接边了，结束；

     （4）最后，邻接边为<0, 4>，把顶点4加入到集合s中，但是顶点4没有邻接边，结束程序。

 

   2.输出从顶点0到各个顶点的最短路径：

     （1）如果当前顶点不是顶点0，如果是顶点1，把1加入到路径d[](保存路径的数组)中，然后path[1]（从0到1最短路径上的顶点1的上一个顶点）是0，把顶点0加入到路径d[]中，结束。接着倒过来输出d[]，从顶点0到顶点1的最短路径为：0->1

     （2