Dijkstra算法：任意两点间的最短路问题 路径还原

 #define _CRT_SECURE_NO_WARNINGS
 /*
 7 10
 0 1 5
 0 2 2
 1 2 4
 1 3 2
 2 3 6
 2 4 10
 3 5 1
 4 5 3
 4 6 5
 5 6 9
 0 6
 */
 #include <iostream>
 #include <vector>
 #include <utility>
 #include <queue>
 #include <functional>
 #include <algorithm>
 #include <cstdio>
 using namespace std;

 const int maxn =  + ;
 const int INF = ;
 int V, E;
 int Prev[maxn];            //最短路上的前驱顶点
 int d[maxn];
 int cost[maxn][maxn];      //i->j 上的权值
 int used[maxn];

 void input();
 void init();
 //求从起点s出发到各个顶点的最短距离
 void dijkstra(int s);

 void init() {
     for (int i = ; i < V; i++) {
         for (int j = ; j < V; j++) {
             if (i == j) {
                 cost[i][j] = ;
             }
             else {
                 cost[i][j] = INF;
             }
         }
     }
 }

 void input()
 {
     int s, t, ct;
     for (int i = ; i < E; i++) {
         cin >> s >> t >> ct;
         cost[s][t] = cost[t][s] = ct;
     }
 }

 //从s点出发到各个顶点的最短距离
 void dijkstra(int s)
 {
     fill(d, d + V, INF);
     fill(used, used + V, false);
     fill(Prev, Prev + V, -);
     d[s] = ;

     while (true) {
         int v = -;
         for (int u = ; u < V; u++) {
             if (!used[u] && (v == - || d[u] < d[v]))
                 v = u;  //找出到下一条尝试的顶点中距离最短的点
         }

         if (v == -) break;
         used[v] = true;

         for (int u = ; u < V; u++) {
             if (d[u] > d[v] + cost[v][u]) {
                 d[u] = d[v] + cost[v][u];  //从v到各个临边u中最短的路-->存放到d[u]，用于下一次计算
                 Prev[u] = v;               //u的前驱是v
             }
         }
     }
 }

 //到顶点t的最短路
 vector<int> get_path(int t) {
     vector<int> path;
     for (; t != -; t = Prev[t]) path.push_back(t);  //不断沿着Prev[t]走直到 t = s
     //这样得到的是按照t到s的顺序，所以翻转之
     reverse(path.begin(), path.end());
     return path;
 }

 int main()
 {
     cin >> V >> E;
     init();
     input();
     int st, ov;
     cin >> st >> ov;
     dijkstra(st);
     cout << d[ov] << endl;
     cout << "Debug..........\n";
     vector<int> path = get_path(ov);
     for (int i = ; i < path.size(); i++) {
         cout << path[i] << " ";
     }

     cout << endl;
     return ;
 }