C语言实现图的最短路径Floyd算法

#include <stdio.h> 
            
#define INFINITY 65535 
 
typedef int VertexType; //顶点是字符型 
typedef int EdgeType; //边是整型 
typedef struct //图的邻接矩阵存储结构 
{ 
 
 VertexType vexs[9]; //顶点向量 
 
 EdgeType edges[9][9];  //邻接矩阵 
 
 int vexnum,arcnum; //图中当前的顶点数和边数 
 
}MGraph; 
 
/* 邻接矩阵的建立*/ 
 
void CreateGraph(MGraph *G) 
{  
 int i,j,k,weight; 
 int ch2,ch3; 
 
 printf("请输入顶点数和边数(输入格式为:顶点数,边数):"); 
 
 scanf("%d,%d",&(G->vexnum),&(G->arcnum)); 
 
 printf("请输入顶点名称(输入格式为:a,b,c...)："); 
 
 for(i=0;i<G->vexnum;i++) 
 { 
  getchar(); 
  scanf("%d",&(G->vexs[i])); 
 } 
   
 for(i=0;i<G->vexnum;i++) 
  for(j=0;j<G->vexnum;j++) 
   if(i==j) 
    G->edges[i][j]=0; 
   else 
    G->edges[i][j]=INFINITY; 
 
  printf("请输入每条边对应的两个顶点名称(输入格式为:a,b):\n"); 
 
  for(k=0;k<G->arcnum;k++) 
  { 
   // getchar(); 
   printf("请输入第%d条边的两个顶点名称：",k+1); 
   scanf("%d,%d",&ch2,&ch3); 
   for(i=0;ch2!=G->vexs[i];i++); 
   for(j=0;ch3!=G->vexs[j];j++); 
   getchar(); 
   printf("请输入第%d条边的权值：",k+1); 
   scanf("%d",&weight);  
   G->edges[i][j]=weight; 
   G->edges[j][i]=weight; 
  } 
  
} 
 
void ShortestPath_Floyd(MGraph G,int P[9][9],int D[9][9]) 
{ 
 int v,w,k; 
 for(v=0;v<G.vexnum;v++)//初始化D和P 
 { 
  for(w=0;w<G.vexnum;w++) 
  { 
   D[v][w]=G.edges[v][w]; 
   P[v][w]=w; 
  } 
 } 
  
 for(k=0;k<G.vexnum;k++) 
 { 
  for(v=0;v<G.vexnum;v++) 
  { 
   for(w=0;w<G.vexnum;w++) 
   { 
    if(D[v][w]>(D[v][k]+D[k][w])) 
    {//如果经过下标为k顶点路径比原两点间路径更短，将当前两点间权值设为更小的一个 
    D[v][w]=D[v][k]+D[k][w]; 
    P[v][w]=P[v][k]; 
    } 
     
   } 
  } 
 } 
} 
void main() 
{ 
 MGraph G; 
 CreateGraph(&G); 
 int i,j; 
 printf("edgesnum:%d\n",G.arcnum); 
 printf("vexesnum:%d\n",G.vexnum); 
 for(i=0;i<9;i++) 
 { 
  for(j=0;j<9;j++) 
   printf("%d ",G.edges[i][j]); 
  printf("\n"); 
 } 
 int v,w,k; 
 int P[9][9]; 
 int D[9][9]; 
 printf("%d\n",P); 
 printf("%d\n",D); 
 ShortestPath_Floyd(G,P,D); 
 for(v=0;v<G.vexnum;v++)//显示路径 
 { 
  for(w=v+1;w<G.vexnum;w++) 
  { 
   printf("v%d-v%d weight:%d ",v,w,D[v][w]); 
   k=P[v][w]; 
   printf("path:%d",v); 
   while(k!=w) 
   { 
    printf("->%d",k); 
    k=P[k][w]; 
   } 
   printf("->%d\n",w); 
  } 
 } 
}