图的最短路径-STL版

图的最短路径-STL版

题目描述
给出一个图的邻接矩阵，输入顶点v，用迪杰斯特拉算法求顶点v到其它顶点的最短路径。

输入
第一行输入t，表示有t个测试实例
第二行输入顶点数n和n个顶点信息
第三行起，每行输入邻接矩阵的一行，以此类推输入n行
第i个结点与其它结点如果相连则为距离，无连接则为0，数据之间用空格
隔开。第四行输入v0，表示求v0到其他顶点的最短路径距离
以此类推输入下一个示例

输出
对每组测试数据，输出：
每行输出v0到某个顶点的最短距离和最短路径
每行格式：v0编号-其他顶点编号-最短路径值----[最短路径]。没有路径输出：v0编号-其他顶点编号–1。具体请参考示范数据

样例输入

2
5 0 1 2 3 4
0 5 0 7 15
0 0 5 0 0
0 0 0 0 1
0 0 2 0 0
0 0 0 0 0
0
6 V0 V1 V2 V3 V4 V5
0 0 10 0 30 100
0 0 5 0 0 0
0 0 0 50 0 0
0 0 0 0 0 10
0 0 0 20 0 60
0 0 0 0 0 0
V0

样例输出

0-1-5----[0 1 ]
0-2-9----[0 3 2 ]
0-3-7----[0 3 ]
0-4-10----[0 3 2 4 ]
V0-V1--1
V0-V2-10----[V0 V2 ]
V0-V3-50----[V0 V4 V3 ]
V0-V4-30----[V0 V4 ]
V0-V5-60----[V0 V4 V3 V5 ]

#include <iostream>
#include <vector>
#include <queue>
#include <climits>
using namespace std;
#define N 100
// 测试样例数 节点数 起始点 状态数组(路径长度) 没有为0
int t, n, map[N][N], start, dis[N], sta[N];

vector<vector<int>> ans;
// 迪杰斯特拉算法 单源
void dijkstra() {
    queue<int> q;
    q.push(start); // 起点先入队
    dis[start] = 0; // 标记
    while (!q.empty()) {
        // 出队 相当于以point为中间点
        int point = q.front();
        // 找到它可以到达的点
        sta[point] = 0;
        for (int i = 0; i < n; i++) {
            // 有路径&以这个中心点为距离小于之前的距离
            if (map[point][i] && dis[i] > dis[point] + map[point][i]) {
                dis[i] = dis[point] + map[point][i];
                // 更新的点加入点集 如果已经无法更新队列将为空
                // 更新路径
                ans[i] = ans[point];
                ans[i].push_back(i);
                q.push(i);
            }
        }
        q.pop();
    }
}

void init() {
    // 初始化状态数组
    for (int i = 0; i < n; i++) {
        dis[i] = INT_MAX;
        sta[i] = 1;
        ans.push_back(vector<int>());
        ans[i].push_back(start);
    }
}

int main() {
    cin >> t;
    while (t--) {
        cin >> n;
        string* s = new string[n];
        for (int i = 0; i < n; i++) { cin >> s[i];}
        for (int i = 0; i < n; i++) { 
            for (int j = 0; j < n; j++) { 
                cin >> map[i][j]; 
            } 
        }
        cin >> start;
        init();
        dijkstra();
        for (int i = 0; i < n; i++) { 
            if (i == start) continue;
            else if (dis[i] == INT_MAX) cout << s[start] << "-" << s[i] << "--1" << endl;
            else {
                cout << s[start] << "-" << s[i] << "-" << dis[i] << "----" << "[";
                for (int j = 0; j < ans[i].size(); j++) { cout << s[ans[i][j]] << " "; }
                cout << "]" << endl;
            }
        }
        ans.clear();
    }
}