#include <cstdio>
#include <iostream>
#include <vector>
#include <list>
#include <stack>

using namespace std;
using Matrix = vector<vector<uint>>;                // 連接矩陣（使用嵌套的vector表示）
using SNodes = vector<tuple<uint, uint, uint>>;     // 已計(jì)算出最短路徑的頂點(diǎn)集合S（類(lèi)似一個(gè)動(dòng)態(tài)數(shù)組）
using UNodes = list<tuple<uint, uint, uint>>;       // 未進(jìn)行遍歷的頂點(diǎn)集合U（使用list主要是方便元素刪除操作）
using ENode = tuple<uint, uint, uint>;              // 每個(gè)節(jié)點(diǎn)包含（頂點(diǎn)編號(hào)，當(dāng)前頂點(diǎn)到起始點(diǎn)最短距離，最短路徑中當(dāng)前頂點(diǎn)的上一個(gè)頂點(diǎn)）信息


/***
 * 從未遍歷的U頂點(diǎn)集合中找到下一個(gè)離起始頂點(diǎn)距離最短的頂點(diǎn)
 * @param unvisitedNodes 未遍歷的U頂點(diǎn)集合
 * 每個(gè)元素是（頂點(diǎn)編號(hào)，當(dāng)前頂點(diǎn)到起始點(diǎn)最短距離，最短路徑中當(dāng)前頂點(diǎn)的上一個(gè)頂點(diǎn)）的tuple
 * @return 下一個(gè)離起始頂點(diǎn)距離最短的頂點(diǎn)
 */
ENode searchNearest(const UNodes &unvisitedNodes) {
    uint minDistance = UINT_MAX;
    ENode nearest;
    for (const auto &node: unvisitedNodes) {
        if (get<1>(node) <= minDistance) {
            minDistance = get<1>(node);
            nearest = node;
        }
    }
    return nearest;
}


/***
 * 迪克斯特拉算法的實(shí)現(xiàn)
 * @param graph 連接矩陣（使用嵌套的vector表示）
 * @param startNodeIndex 起始點(diǎn)編碼（從0開(kāi)始）
 * @return 返回一個(gè)vector，每個(gè)元素是到起始頂點(diǎn)的距離排列的包含（頂點(diǎn)編號(hào)，當(dāng)前頂點(diǎn)到起始點(diǎn)最短距離，最短路徑中當(dāng)前頂點(diǎn)的上一個(gè)頂點(diǎn)）的tuple
 */
SNodes dijkstra(const Matrix &graph, uint startNodeIndex) {
    const uint numOfNodes = graph.size();   // 圖中頂點(diǎn)的個(gè)數(shù)
    // S是已計(jì)算出最短路徑的頂點(diǎn)的集合（頂點(diǎn)編號(hào)，當(dāng)前頂點(diǎn)到起始點(diǎn)最短距離，最短路徑中當(dāng)前頂點(diǎn)的上一個(gè)頂點(diǎn)）
    SNodes visitedNodes;
    // U是未計(jì)算出最短路徑的頂點(diǎn)的集合（其中的key為頂點(diǎn)編號(hào)，value為到起始頂點(diǎn)最短距離和最短路徑中上一個(gè)節(jié)點(diǎn)編號(hào)組成的pair）
    UNodes unvisitedNodes;

    // 對(duì)S和U集合進(jìn)行初始化，起始頂點(diǎn)的距離為0，其他頂點(diǎn)的距離為無(wú)窮大
    // 最短路徑中當(dāng)前頂點(diǎn)的上一個(gè)頂點(diǎn)初始化為起始頂點(diǎn)，后面會(huì)逐步進(jìn)行修正
    for (auto i = 0; i < numOfNodes; ++i) {
        if (i == startNodeIndex) visitedNodes.emplace_back(i, 0, startNodeIndex);
        else unvisitedNodes.emplace_back(i, graph[startNodeIndex][i], startNodeIndex);
    }

    while (!unvisitedNodes.empty()) {
        // 從U中找到距離起始頂點(diǎn)距離最短的頂點(diǎn)，加入S，同時(shí)從U中刪除
        auto nextNode = searchNearest(unvisitedNodes);
        unvisitedNodes.erase(find(unvisitedNodes.begin(), unvisitedNodes.end(), nextNode));
        visitedNodes.emplace_back(nextNode);
        // 更新U集合中各個(gè)頂點(diǎn)的最短距離以及最短路徑中的上一個(gè)頂點(diǎn)
        for (auto &node: unvisitedNodes) {
            // 更新的判斷依據(jù)就是起始頂點(diǎn)到當(dāng)前頂點(diǎn)（nextNode）距離加上當(dāng)前頂點(diǎn)到U集合中頂點(diǎn)的距離小于原來(lái)起始頂點(diǎn)到U集合中頂點(diǎn)的距離
            // 更新最短距離的時(shí)候同時(shí)需要更新最短路徑中的上一個(gè)頂點(diǎn)為nextNode
            if (graph[get<0>(nextNode)][get<0>(node)] != UINT_MAX &&
                graph[get<0>(nextNode)][get<0>(node)] + get<1>(nextNode) < get<1>(node)) {
                get<1>(node) = graph[get<0>(nextNode)][get<0>(node)] + get<1>(nextNode);
                get<2>(node) = get<0>(nextNode);
            }
        }
    }

    return visitedNodes;
}


/***
 * 對(duì)使用迪克斯特拉算法求解的最短路徑進(jìn)行打印輸出
 * @param paths vector表示的最短路徑集合
 * 每個(gè)元素是到起始頂點(diǎn)的距離排列的包含（頂點(diǎn)編號(hào)，當(dāng)前頂點(diǎn)到起始點(diǎn)最短距離，最短路徑中當(dāng)前頂點(diǎn)的上一個(gè)頂點(diǎn)）的tuple
 */
void print(const SNodes &paths) {
    stack<int> tracks;  //從尾部出發(fā)，使用stack將每個(gè)頂點(diǎn)的最短路徑中的前一個(gè)頂點(diǎn)入棧，然后出棧的順序就是最短路徑順序
    // 第一個(gè)元素是起始點(diǎn)，從第二個(gè)元素進(jìn)行打印輸出
    for (auto it = ++paths.begin(); it != paths.end(); ++it) {
        // 打印頭部信息
        printf("%c -> %c:\t Length: %d\t Paths: %c",
               char(get<0>(paths[0]) + 65),
               char(get<0>(*it) + 65),
               get<1>(*it),
               char(get<0>(paths[0]) + 65));
        auto pointer = *it;
        // 如果當(dāng)前指針pointer指向的節(jié)點(diǎn)有中途節(jié)點(diǎn)（判斷的條件是最短路徑中的前一個(gè)節(jié)點(diǎn)不是起始點(diǎn)）
        while (get<2>(pointer) != get<0>(paths[0])) {
            tracks.push(get<0>(pointer));
            // Lambda表達(dá)式，使用find_if函數(shù)把當(dāng)前頂點(diǎn)的前一個(gè)頂點(diǎn)從paths中找出來(lái)繼續(xù)進(jìn)行循環(huán)直到前一個(gè)節(jié)點(diǎn)就是起始點(diǎn)
            auto condition = [pointer](tuple<uint, uint, uint> x) { return get<0>(x) == get<2>(pointer); };
            pointer = *find_if(paths.begin(), paths.end(), condition);
        }
        tracks.push(get<0>(pointer));

        // 以出棧的順序進(jìn)行打印輸出
        while (!tracks.empty()) {
            printf(" -> %c", char(tracks.top() + 65));
            tracks.pop();
        }
        printf("\n");
    }
}

int main() {
    Matrix graph = {
            {0,        12,       UINT_MAX, UINT_MAX, UINT_MAX, 16, 14},
            {12,       0,        10,       UINT_MAX, UINT_MAX, 7, UINT_MAX},
            {UINT_MAX, 10,       0, 3,               5,        6, UINT_MAX},
            {UINT_MAX, UINT_MAX, 3, 0,               4, UINT_MAX, UINT_MAX},
            {UINT_MAX, UINT_MAX, 5, 4,               0,        2,  8},
            {16,       7,        6,        UINT_MAX, 2,        9,  9},
            {14,       UINT_MAX, UINT_MAX, UINT_MAX, 8,        9,  0}
    };  // 圖對(duì)應(yīng)的連接矩陣
    auto results = dijkstra(graph, uint('D' - 65));          // 選取頂點(diǎn)C（大寫(xiě)字母A的ASCII編碼是65）
    print(results);     // 打印輸出結(jié)果
    return 0;
}