算法训练 Car的旅行路线

算法训练 Car的旅行路线
又到暑假了，住在城市A的Car想和朋友一起去城市B旅游。她知道每个城市都有四个飞机场，分别位于一个矩形的四个顶点上，同一个城市中两个机场之间有一 条笔直的高速铁路，第I个城市中高速铁路的单位里程价格为Ti，任意两个不同城市的机场之间均有航线，所有航线单位里程的价格均为t。找出一条从城市A到B的旅游路线，出发和到达城市中的机场可以任意选取，要求总的花费最少。
输入格式
　　第一行有四个正整数s，t，A，B。
　　S表示城市的个数，t表示飞机单位里程的价格，A，B分别为城市A，B的序号，(1<=A，B<=S)。
　　接下来有S行，其中第I行均有7个正整数xi1，yi1，xi2，yi2，xi3，yi3，Ti，这当中的(xi1，yi1)，(xi2，yi2)，(xi3，yi3)分别是第I个城市中任意三个机场的坐标，T I为第I个城市高速铁路单位里程的价格。
输出格式
　　共有n行，每行一个数据对应测试数据，保留一位小数。
样例输入
3 10 1 3
1 1 1 3 3 1 30
2 5 7 4 5 2 1
8 6 8 8 11 6 3
样例输出
47.55
题解:多源最短路 Floryd

#include<bits/stdc++.h>
using namespace std;
int x[507],y[507],v[105];
double c[507][507];
const double MAX = 1e9;
void getfourth(int k){
	if(abs((x[k*4]-x[k*4+1])*(x[k*4]-x[k*4+2]))==abs((y[k*4]-y[k*4+1])*(y[k*4]-y[k*4+2]))){
        x[k*4+3]=x[k*4+1]+(x[k*4+2]-x[k*4]);
        y[k*4+3]=y[k*4+1]+(y[k*4+2]-y[k*4]);
    }
    else if(abs((x[k*4+1]-x[k*4])*(x[k*4+1]-x[k*4+2]))==abs((y[k*4+1]-y[k*4])*(y[k*4+1]-y[k*4+2]))){
        x[k*4+3]=x[k*4]+(x[k*4+2]-x[k*4+1]);
        y[k*4+3]=y[k*4]+(y[k*4+2]-y[k*4+1]);
    }
    else{
        x[k*4+3]=x[k*4]+(x[k*4+1]-x[k*4+2]);
        y[k*4+3]=y[k*4]+(y[k*4+1]-y[k*4+2]);
    }
}
int main(){
	int s,t,A,B;
	cin>>s>>t>>A>>B;
	for(int i=0;i<s;i++){
		cin>>x[i*4+0]>>y[i*4+0]>>x[i*4+1]>>y[i*4+1]>>x[i*4+2]>>y[i*4+2]>>v[i];
		getfourth(i); 
	}
	for(int i=0;i<4*s;i++){         
        for(int j=0;j<4*s;j++){
            c[i][j]=MAX;
            if(i==j) c[i][j]=0; 
        }
    }
     for(int i=0;i<4*s;i++){
        for(int j=0;j<4*s;j++){
            if(i/4==j/4){
                c[i][j]=sqrt((x[i]-x[j])*(x[i]-x[j])*1.0+(y[i]-y[j])*(y[i]-y[j])*1.0)*v[i/4];
            }else{
                c[i][j]=sqrt((x[i]-x[j])*(x[i]-x[j])*1.0+(y[i]-y[j])*(y[i]-y[j])*1.0)*t;
            }
        }
    }
     for(int i=0;i<4*s;i++){
        for(int j=0;j<4*s;j++){
            for(int k=0;k<4*s;k++){
                c[j][k]=min(c[j][k],c[j][i]+c[i][k]);
            }
        } 
    }
    double ans=MAX;
    for(int i=(A-1)*4;i<=(A-1)*4+3;i++){
        for(int j=(B-1)*4;j<=(B-1)*4+3;j++){
            ans=min(ans,c[i][j]);
        }
    }
    printf("%.1lf\n",ans);
    return 0;
}