noip2001-4 Car的旅行路线

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

输入格式
第一行有四个正整数s，t，A，B。S(0S<=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个城市高速铁路单位里程的价格。

输出格式
输出最小费用(结果保留两位小数)

样例输入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
样例输出1
47.55

又是裂点+最短路，此题的难点仍然在于构图，输入只给了我们三个机场，为了求第4个机场，我们可以枚举哪个点作为直角点，然后用勾股定理来判断。（今天写了两道近3000B的裂点最短路，感觉身体被掏空）

#include<cstdio>
#include<iostream>
#include<algorithm>
#include<cstring>
#include<cmath>
#define ll long long
#define db double
using namespace std;
int n,A,B,tot,l,r;
db fly,ans;
int ok[405],g[40005],head[405],Next[200000],to[200000];
db len[200000],f[405];
struct ty
{
    db x[5],y[5];
    db train;
}p[105];
db spfa(int start)
{
    for(int i=1;i<=n*4;i++) 
    {
        f[i]=1e9;
        ok[i]=0;
    }
    f[start]=0;
    int t=0,w=1;
    g[1]=start;
    ok[start]=1;
    while(t<w) 
    {
        t++;
        int x=g[t];
        ok[x]=0;
        for(int i=head[x];i!=-1;i=Next[i]) 
        if(f[x]+len[i]<f[to[i]]) 
        {
            f[to[i]]=f[x]+len[i];
            if(ok[to[i]]==0) 
            {
                w++;
                g[w]=to[i];
                ok[to[i]]=1;
            }
        }
    }
    return min(min(min(f[(B-1)*4+1],f[(B-1)*4+2]),f[(B-1)*4+3]),f[B*4]);
}
db getdis(db x1,db y1,db x2,db y2)
{
    return (x1-x2)*(x1-x2)+(y1-y2)*(y1-y2);
}
void find4(int k)
{
    db d1=getdis(p[k].x[1],p[k].y[1],p[k].x[2],p[k].y[2]);
    db d2=getdis(p[k].x[1],p[k].y[1],p[k].x[3],p[k].y[3]);
    db d3=getdis(p[k].x[2],p[k].y[2],p[k].x[3],p[k].y[3]);
    if(d1+d2==d3) 
    {
        p[k].x[4]=p[k].x[2]+p[k].x[3]-p[k].x[1];
        p[k].y[4]=p[k].y[2]+p[k].y[3]-p[k].y[1];
    }
    else
    if(d1+d3==d2) 
    {
        p[k].x[4]=p[k].x[1]+p[k].x[3]-p[k].x[2];
        p[k].y[4]=p[k].y[1]+p[k].y[3]-p[k].y[2];
    }
    else
    if(d2+d3==d1) 
    {
        p[k].x[4]=p[k].x[1]+p[k].x[2]-p[k].x[3];
        p[k].y[4]=p[k].y[1]+p[k].y[2]-p[k].y[3];
    }
}   
void add(int x,int y,db z)
{
    tot++;
    Next[tot]=head[x];
    to[tot]=y;
    len[tot]=z;
    head[x]=tot;
}
int main()
{
    cin>>n>>fly>>A>>B;
    for(int i=1;i<=n;i++) 
    {
        scanf("%lf%lf%lf%lf%lf%lf%lf",&p[i].x[1],&p[i].y[1],&p[i].x[2],&p[i].y[2],&p[i].x[3],&p[i].y[3],&p[i].train);
        find4(i);
    }
    for(int i=1;i<=n*4;i++) head[i]=-1;
    for(int i=1;i<=n;i++) 
    {
        for(int j=1;j<=4;j++) 
        for(int k=1;k<=4;k++) 
        if(j<k) 
        {
            l=(i-1)*4+j;
            r=(i-1)*4+k;
            add(l,r,p[i].train*sqrt(getdis(p[i].x[j],p[i].y[j],p[i].x[k],p[i].y[k])));
            add(r,l,p[i].train*sqrt(getdis(p[i].x[j],p[i].y[j],p[i].x[k],p[i].y[k])));
        }
    }
    for(int i=1;i<=n;i++) 
    for(int j=1;j<=4;j++) 
    for(int k=1;k<=n;k++) 
    if(k>i)
    for(int t=1;t<=4;t++) 
    {
        l=(i-1)*4+j;
        r=(k-1)*4+t;
        add(l,r,fly*sqrt(getdis(p[i].x[j],p[i].y[j],p[k].x[t],p[k].y[t])));
        add(r,l,fly*sqrt(getdis(p[i].x[j],p[i].y[j],p[k].x[t],p[k].y[t])));
    }
    ans=1e9;
    for(int i=1;i<=4;i++) 
    ans=min(ans,spfa((A-1)*4+i));
    printf("%0.2f",ans);
    return 0;
}