Car的旅行路线（codevs 1041）

题目描述 Description

又到暑假了，住在城市A的Car想和朋友一起去城市B旅游。她知道每个城市都有四个飞机场，分别位于一个矩形的四个顶点上，同一个城市中两个机场之间有一条笔直的高速铁路，第I个城市中高速铁路了的单位里程价格为Ti，任意两个不同城市的机场之间均有航线，所有航线单位里程的价格均为t。

那么Car应如何安排到城市B的路线才能尽可能的节省花费呢?她发现这并不是一个简单的问题，于是她来向你请教。
任务
找出一条从城市A到B的旅游路线，出发和到达城市中的机场可以任意选取，要求总的花费最少。

输入描述 Input Description

第一行为一个正整数n(0<=n<=10)，表示有n组测试数据。
每组的第一行有四个正整数s，t，A，B。
S(0<S<=100)表示城市的个数，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个城市高速铁路单位里程的价格。

输出描述 Output Description

共有n行，每行一个数据对应测试数据。

样例输入 Sample Input

1
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

样例输出 Sample Output

47.5

/*
  暴力的预处理加Floyed求最短路
  预处理：
    将n个城市拓展为4*n个飞机场，
    belong[i]表示第i个飞机场属于哪个城市
    map[][]储存飞机场间的距离，用于Floyed更新 
*/
#include<cstdio>
#include<iostream>
#include<cstring>
#include<cmath>
#define M 410
#define INF 9999999
using namespace std;
double x[M],y[M],map[M][M],t;
int belong[M],n,A,B,tot=0;
void get_four(int i,int zh)
{
    int r1=tot-2,r2=tot-1,r3=tot,rr;
    map[r1][r2]=map[r2][r1]=pow(x[r1]-x[r2],2)+pow(y[r1]-y[r2],2);
    map[r1][r3]=map[r3][r1]=pow(x[r1]-x[r3],2)+pow(y[r1]-y[r3],2);
    map[r3][r2]=map[r2][r3]=pow(x[r3]-x[r2],2)+pow(y[r3]-y[r2],2);
    if(map[r1][r2]+map[r1][r3]==map[r2][r3])rr=r1;
    else if(map[r1][r2]+map[r2][r3]==map[r1][r3])rr=r2;
    else rr=r3;
    tot++;
    if(rr==r1){double xx=x[r1]-x[r2],yy=y[r1]-y[r2];x[tot]=x[r3]-xx;y[tot]=y[r3]-yy;}
    if(rr==r2){double xx=x[r1]-x[r2],yy=y[r1]-y[r2];x[tot]=x[r3]+xx;y[tot]=y[r3]+yy;}
    if(rr==r3){double xx=x[r1]-x[r3],yy=y[r1]-y[r3];x[tot]=x[r2]+xx;y[tot]=y[r2]+yy;}
    for(int j=tot-3;j<=tot;j++)
      for(int k=tot-3;k<j;k++)
        map[j][k]=map[k][j]=sqrt(pow(x[j]-x[k],2)+pow(y[j]-y[k],2))*zh;
    belong[tot]=i;
}
void floyed()
{
    for(int k=1;k<=tot;k++)
      for(int i=1;i<=tot;i++)
        for(int j=1;j<=tot;j++)
          if(i!=j&&i!=k&&j!=k)
            map[i][j]=min(map[i][k]+map[k][j],map[i][j]);
    double ans=INF;
     for(int i=1;i<=tot;i++)
       for(int j=1;j<=tot;j++)
        if(belong[i]==A&&belong[j]==B)
          ans=min(map[i][j],ans);
    printf("%.1lf\n",ans);
}
void work()
{
    scanf("%d%lf%d%d",&n,&t,&A,&B);
    for(int i=1;i<=n;i++)
    {
        for(int j=1;j<=3;j++)
        {
            tot++;
            scanf("%lf%lf",&x[tot],&y[tot]);
            belong[tot]=i;
        }
        int x;
        scanf("%d",&x);
        get_four(i,x);
    }
    for(int i=1;i<=tot;i++)
      for(int j=1;j<i;j++)
        if(belong[i]!=belong[j])
          map[i][j]=map[j][i]=sqrt(pow(x[i]-x[j],2)+pow(y[i]-y[j],2))*t;
    floyed();
}
int main()
{
    int T;
    scanf("%d",&T);
    while(T--)
    {
        memset(map,0,sizeof(map));
        memset(x,0,sizeof(x));
        memset(y,0,sizeof(y));
        memset(belong,0,sizeof(belong));
        work();
    }
    return 0;
}