Floyd算法——C语言实现

之前，对Floyd算法一直有很大困惑，参考别人的博客进行分析，还是没有懂得怎么标记所经过的路径，今天去图书馆左一本书，又一本书的翻阅今天终于懂得了一些，现记录如下：

#include<stdio.h>
#include<stdlib.h>
#include<string.h>
#define N 100
int dist[N][N],path[N][N]={0};


typedef struct graph
{
int vexnum,arcnum;//顶点数，弧度数
int vex[N];          //顶点向量
int AdjMatrix[N][N];       //权值矩阵
}graph;


graph G;


FILE *fp;




void init_matrix(int dist[N][N],int num,int k)
{
int i,j,flag=0;
if(k==-1)
flag=1;
for(i=0;i<num;++i)
for(j=0;j<num;++j)
{
if(flag)
dist[i][j]=j;
   else
   dist[i][j]=k;
}
}


void display(int dist[N][N],int num)
{
int i,j;
printf("O(∩_∩)O~该矩阵为(%d*%d)\n",num,num);
fprintf(fp,"O(∩_∩)O~该矩阵为(%d*%d)\n",num,num);
for(i=0;i<num;++i)
{
for(j=0;j<num;++j)
{
printf("%d\t",dist[i][j]);
fprintf(fp,"%d\t",dist[i][j]);
}
printf("\n\n");
fprintf(fp,"\n\n");
}
}


void show(int m,int n)
{
int k;


k=path[m][n];
if(k==n)
return;
printf(" V%d ->",k+1);

show(k,n);
}


void floyd_shortpath(int dist[N][N],int num,int m,int n)
{
int i,j,k;
for(k=0;k<num;++k)
for(i=0;i<num;++i)
for(j=0;j<num;j++)
if(dist[i][j]>dist[i][k]+dist[k][j])
{
dist[i][j]=dist[i][k]+dist[k][j];
path[i][j]=path[i][k];
printf("dist矩阵：\n");
fprintf(fp,"dist矩阵：\n");
display(dist,num);
printf("Path矩阵：\n");
fprintf(fp,"Path矩阵：\n");
display(path,num);
}
printf("最终的权值矩阵为：\n");
fprintf(fp,"最终的权值矩阵为：\n");
    display(dist,num);
}


void welcome()
{
printf("#############################################################################\n\n\n");
fprintf(fp,"#############################################################################\n\n\n");
printf("\t@@@@@@@@@@@@@@@@@@欢迎使用最短路径求解程序@@@@@@@@@@@@@@@@@@@@@@\t\n\n\n");
fprintf(fp,"\t@@@@@@@@@@@@@@@@@@欢迎使用最短路径求解程序@@@@@@@@@@@@@@@@@@@@@@\t\n\n\n");
printf("\t\t................版权所有 , 翻版必究...............\n\n\n");
fprintf(fp,"\t\t................版权所有 , 翻版必究...............\n\n\n");
}


int main()
{
int i,j,w,t,m,n;
if((fp=fopen("d:\\data.txt","a"))==NULL)
{
printf("error");
exit(0);
}
welcome();
    // int num,total;
printf("请输入城市个数（顶点数）：");
fprintf(fp,"请输入城市个数（顶点数）：");
scanf("%d",&G.vexnum);
fprintf(fp,"%d\n",G.vexnum);
//num=G.vexnum;
init_matrix(dist,G.vexnum,32767);
init_matrix(path,G.vexnum,-1);
display(dist,G.vexnum);
printf("请输入有多少组城市直接相连（弧度数）：");
fprintf(fp,"请输入有多少组城市直接相连（弧度数）：");
    scanf("%d",&G.arcnum);
fprintf(fp,"%d\n",G.arcnum);
//total=G.arcnum;
    printf("请输入起点、终点及权值：\n");
fprintf(fp,"请输入起点、终点及权值：\n");
for(t=0;t<G.arcnum;t++)
{
  scanf("%d %d %d",&i,&j,&w);
  fprintf(fp,"%d\t%d\t%d\n",i,j,w);
  G.AdjMatrix[i-1][j-1]=w;
  dist[i-1][j-1]=w;
  G.AdjMatrix[j-1][i-1]=w;
  dist[j-1][i-1]=w;                //若有此行，为无向图，如无此行，为有向图
}
printf("初始矩阵为：");
fprintf(fp,"初始矩阵为：");
display(dist,G.vexnum);
printf("请输入起点、终点：");
fprintf(fp,"请输入起点、终点：");
while(scanf("%d %d",&m,&n)!=EOF)
{
fprintf(fp,"%d\t%d\n",m,n);
floyd_shortpath(dist,G.vexnum,m-1,n-1);
printf("V%d-V%d weight: %d \n",m,n,dist[m-1][n-1]);
fprintf(fp,"V%d-V%d weight: %d \n",m,n,dist[m-1][n-1]);
printf("V%d -> ",m);
fprintf(fp,"V%d -> ",m);
    show(m-1,n-1);
printf(" V%d\n",n);
fprintf(fp," V%d\n",n);
fclose(fp);
}
return 0;
}