Floyd算法

#include<iostream>
using namespace std;
int map[100][100];
void Init(int N)
{
    for(int i=1; i<=N; i++){
        for(int j=1; j<=N; j++){
            if(i == j)
            map[i][j] = 0;
            else
            map[i][j] = 999;
        }
    }
}
void Floyd(int N)
{
    for(int k=1; k<=N; k++){
        for(int i=1; i<=N; i++){
            for(int j=1; j<=N; j++){
                if(map[i][k] + map[k][j] < map[i][j])
                map[i][j] = map[i][k] + map[k][j];
            }
        }
    }
}
int main()
{
    int N, M, S;// N 表示点的个数， M 表示边的个数, S 表示出发点 
    int v1, v2, len;
    
    cin>>N>>M>>S;
    
    Init(N);
    for(int i=0; i<M; i++){
        cin>>v1>>v2>>len;
        map[v1][v2] = len;
        map[v2][v1] = len;
    }
    Floyd(N);
    for(int i=1; i<=N; i++)
    cout<<map[i][S]<<" ";
} 
/*测试用例 
5 6 1
1 2 14
1 3 2
1 4 6
2 5 2
3 4 3
4 5 1
*/