Dijkstra算法

#include<iostream>
using namespace std;
typedef struct Graph
{
    public :
        int visit[100];
        int map[100][100];
        int len[100];
        int v;
}Graph;
Graph G;
void Init(int N, int M)
{
    G.v = N;
    for(int i=1; i<=G.v; i++){
        G.visit[i] = 0;
        G.len[i] = 0;
        for(int j=1; j<=G.v; j++){
            G.map[i][j] = 999;
        }
    }
    
    int v1, v2, len;
    for(int i=0; i<M; i++){
        cin>>v1>>v2>>len;
        G.map[v1][v2] = len;
        G.map[v2][v1] = len;
        //cout<<G.map[v1][v2]<<endl;
    }
}
void Dijkstra(int V)
{
    G.visit[V] = 1; // 标记原点已访问
    
    for(int i=1; i<=G.v; i++){//初始化各点到原点的距离 
        G.len[i] = G.map[i][V];
    }
    G.len[V] = 0;
    
    for(int n=1; n<G.v; n++){//循环 v-1 次，每次找到到已访问的点中最近的路径 
        int minlen = 999;
        int k;
        for(int i=1; i<=G.v; i++){
            // 每次找到未访问的最近的点 
            if(G.len[i] < minlen && G.visit[i] == 0){
                minlen = G.len[i];
                k = i;
            }
        
        }
        G.visit[k] = 1;// 标记已访问
        cout<<"K: "<<k<<endl;
        // 根据找到的最近的点更新到原点的距离 
        for(int i=1; i<=G.v; i++){
            if(G.visit[i] == 0 && G.len[i] > G.len[k] + G.map[k][i])
            G.len[i] = G.len[k] + G.map[k][i];
        } 
        
    }
}
int main()
{
    // N 表示有几个点， M 表示有几条变， V 表示原点 
    int N, M, V;
    
    cin>>N>>M>>V;
    Init(N, M);
    Dijkstra(V);
    for(int i=1; i<=G.v; i++)
    cout<<G.len[i]<<" ";
} 
/* 测试实例 
5 6 1
1 2 14
1 3 2
1 4 6
2 5 2
3 4 3
4 5 1
*/