用Floyed算法求最短路径

Floyed算法是可以随便给两个点就可以求出这两个点的最短路径长度以及走法，求单源最短路径可以用Dijkstra（迪杰斯特拉）算法，只要求一个点到其余点的最短距离，只要建一个一位数组存取最短路径即可。而Floyed算法是求每个点到其余各点的最短路径可以建立个二维数组来存取最短路径值。

下面的程序中：

1.采用了文本输入的形式，有两种文本输入方式，大家可以对比下，一种是c++的文件读入，另一种是c语言的输入方式。

2.的d[4][4]存两点之间的长度，path[4][4]存的是怎么到达那个点，存的是路径。

3.我已经定义了该图为4*4的矩阵，大家可以自己定义，已经规定了有4个点。

4.可以试试我的输入列子：

首先d[4][4]为：

0 1 1000 4
1000 0 9 2
3 5 0 8
1000 1000 6 0

规定不可达为1000

path[4][4]为：

-1 0 -1 1
-1 -1 1 1
2 2 -1 2
-1 -1 3 -1

-1表示不可达，其他的数字表示这个点能到。如：第一行的0，表示0可以到1，假设四个点的标号分别为0,1,2,3

上面的列子是有向图，可以根据我的d[4][4]画出图来

#include<iostream>
#include<fstream>//文件读入读出判断的头文件
#include<cstdlib>//exit(1)判断的头文件
#include<cstdio>//freopen函数的头文件
using namespace std;
int main()
{
    int d[4][4],i,j,k,path[4][4],p1,p2,p[5000],t,t1;

    {
        t1=0;
    ifstream infile("f1.txt");//freopen("f1.txt","r",stdin);
    if(!infile)
    {
        cerr<<"open error!"<<endl;
        exit(1);
    }
    for(i=0;i<4;i++)
    {
     for(j=0;j<4;j++)
     {
       infile>>d[i][j];
       cout<<d[i][j]<<' ';
     }
     cout<<endl;
    }
    for(i=0;i<4;i++)
     for(j=0;j<4;j++)
       infile>>path[i][j];
       for(k=0;k<4;k++)
        for(i=0;i<4;i++)
         for(j=0;j<4;j++)
         {
          if(d[i][j]>(d[i][k]+d[k][j]))
         {
             d[i][j]=d[i][k]+d[k][j];
             path[i][j]=k;
         }
         }
         for(i=0;i<4;i++)
         {
          for(j=0;j<4;j++)
           cout<<d[i][j]<<' ';
           cout<<endl;
         }
         for(i=0;i<4;i++)
         {
          for(j=0;j<4;j++)
           cout<<path[i][j]<<' ';
           cout<<endl;
         }
         infile.close();//注意要把文件结束后才可以在从键盘上输入
      while(cin>>p1>>p2)
      {
             cout<<"The least short road ia "<<d[p1][p2]<<endl;
             t=p2;
             if(path[p1][p2]!=p1)
             {
                 t1=1;
             for(i=0;path[p1][p2]!=p1;i++)
             {
                 p[i]=path[p1][p2];
                 p2=path[p1][p2];
             }
             }
             cout<<"The road display is ";
             cout<<p1<<"->";
             if(t1)for(j=i-1;j>=0;j--)
                  cout<<p[j]<<"->";
             cout<<t;
             cout<<endl;
      }
         }
  return 0;
}