算法訓練 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;
}