3.3最短路问题，输出路径

最优子结构证明：

思路：从多段图

第二段开始到最后一段，每段找到一个点到原点的距离距离最短

代码如下：

#include<iostream>
#include<cstdio>
#include<cstring>
using namespace std;
const int INF=0x3f3f3f3f;
int matrix[103][103],d[103],vis[103],pre[103],path[103];
int n=7;

void dijkstra(int s){
    for(int i=1;i<=n;i++){
        d[i]=matrix[1][i];
        pre[i]=s;
    }
    memset(vis,0,sizeof(vis));
    for(int k=1;k<=n;k++){
        int v=-1;
        for(int i=1;i<=n;i++){
            if(!vis[i]&&(v==-1||d[i]<d[v]))v=i;
        }
        vis[v]=1;
        for(int i=1;i<=n;i++){
            int tmp=d[v]+matrix[v][i];
            if(tmp<d[i]){
                d[i]=tmp;
                pre[i]=v;
            }
        }
    }
}
void printPath(int en){
    printf("从起点到%d的路径是：\n",en);
    path[0]=en;
    int k=1;
    for(int i=pre[en];i!=1;i=pre[i]){
        path[k++]=i;
    }
    printf("1");
    for(int i=k-1;i>=0;i--){
        printf("->%d",path[i]);
    }
    printf("\n");
}

int main(){
    printf("请以矩阵的形式输入7个地点之间的相互距离\n");
    for(int i=1;i<=n;i++){
        for(int j=1;j<=n;j++){
            scanf("%d",&matrix[i][j]);
        }
    }
    dijkstra(1);
    printf("王老师到各地的最短距离分别是：\n");
    for(int i=1;i<=n;i++){
        printf("%3d",d[i]);
    }
    printf("\n");

    for(int i=2;i<=n;i++){
        printPath(i);
    }
}