蓝桥杯 算法训练 Car的旅行路线

问题描述

　　又到暑假了，住在城市A的Car想和朋友一起去城市B旅游。她知道每个城市都有四个飞机场，分别位于一个矩形的四个顶点上，同一个城市中两个机场之间有一 条笔直的高速铁路，第I个城市中高速铁路了的单位里程价格为Ti，任意两个不同城市的机场之间均有航线，所有航线单位里程的价格均为t。
　　那么Car应如何安排到城市B的路线才能尽可能的节省花费呢?她发现这并不是一个简单的问题，于是她来向你请教。
　　找出一条从城市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行，每行一个数据对应测试数据，保留一位小数。

样例输入

1
1 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

数据规模和约定

　　0<S<=100，

借鉴一位大佬的：

#include<bits/stdc++.h>
using namespace std;
int x[101*4],y[101*4];
double price[401][401]={0};
int value[101];
const double inf=999999;
void makesqrt(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;
    scanf("%d%d%d%d",&s,&t,&A,&B);
    for(int i=0;i<s;i++){
        scanf("%d%d%d%d%d%d%d",&x[i*4],&y[i*4],&x[i*4+1],&y[i*4+1],&x[i*4+2],&y[i*4+2],&value[i]);
        makesqrt(i);
    }
    for(int i=0;i<4*s;i++){         //price二维数组初始化 
        for(int j=0;j<4*s;j++){
            price[i][j]=inf;
            if(i==j) price[i][j]=0; 
        }
    }
    for(int i=0;i<4*s;i++){
        for(int j=0;j<4*s;j++){
            if(i/4==j/4){
                price[i][j]=sqrt((x[i]-x[j])*(x[i]-x[j])*1.0+(y[i]-y[j])*(y[i]-y[j])*1.0)*value[i/4];   //城市间的高速路 
            }else{
                price[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 b=0;b<4*s;b++){
        for(int i=0;i<4*s;i++){
            for(int j=i+1;j<4*s;j++){
                price[i][j]=min(price[i][j],price[i][b]+price[b][j]);
            }
        } 
    }
    double ans=inf;
    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,price[i][j]);
        }
    }
    printf("%.1lf\n",ans);
    return 0;
}