【板子】Floyd算法及路径记录

Floyd算法实现：将距离矩阵初始化为邻接矩阵，然后做一个三层的for循环
至于给出路径只要对path二维数组进行递归就行了

int matrix[n][n];
int dist[n][n];
int path[n][n];
for(int i = 0; i < n; ++i)
{
    for(int j = 0; j < n; ++j)
    {
        dist[i][j] = matrix[i][j];
        path[i][j] = -1;
    }
}

///floyd算法实现
for(int k = 0; k < n; ++k)
{
    for(int i = 0; i < n; ++i)
    {
        for(int j = 0; j < n; ++j)
        {
            if(dist[i][j] > dist[i][k] + dist[k][j])
            {
                dist[i][j] = dist[i][k] + dist[k][j];
                path[i][j] = k;
            }
        }
    }
}

///找到任意两个顶点之间的路径
int path_[n]; path[0] = i;
int k = 1;
///k，path，path_三个变量必须都是全局变量，
///不然下面的函数还需要传入矩阵参数，在递归过程中很
///耗费内存
void retrieve_path(int i, int j)
{
    if(i == j) return;
    if(path[i][j] == -1)
        path_[k++] = j;
    else
    {
        retrieve_path(i, path[i][j]);
        retrieve_path(path[i][j], j);
    }
}