題目描述
又到暑假了，住在城市A的Car想和朋友一起去城市B旅遊。她知道每個城市都有四個飛機場，分別位於一個矩形的四個頂點上，同一個城市中兩個機場之間有一條筆直的高速鐵路，第I個城市中高速鐵路了的單位里程價格為Ti，任意兩個不同城市的機場之間均有航線，所有航線單位里程的價格均為t。

圖例（從上而下）
機場 高速鐵路 飛機航線
注意：圖中並沒有標出所有的鐵路與航線。
那麼Car應如何安排到城市B的路線才能儘可能的節省花費呢?她發現這並不是一個簡單的問題，於是她來向你請教。
找出一條從城市A到B的旅遊路線，出發和到達城市中的機場可以任意選取，要求總的花費最少。
輸入輸出格式
輸入格式：

第一行為一個正整數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個城市高速鐵路單位里程的價格。

輸出格式：

共有n行，每行一個數據對應測試資料。 保留一位小數

輸入輸出樣例
輸入樣例#1：
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.5

建圖很麻煩，如何求第四個頂點的座標。
可以根據向量垂直，暴力判斷出直角頂點，之後橫或縱（4）=橫或縱（銳角1）+橫或縱（銳角2）-橫或縱（直角）。
最後暴力跑spfa（）。

#include<iostream>
#include<cstdio>
#include<queue>
#include<cmath>
using namespace std;
int T,n,v,s,e,t[105],a[105][5][2];
double ans,dis[105][5];
bool b[105][5];
struct airp
{
    int
 
 x,y;
}tmp;
queue<airp>q;
int pd(int u)
{
    if((a[u][2][0]-a[u][1][0])*(a[u][3][0]-a[u][1][0])+(a[u][2][1]-a[u][1][1])*(a[u][3][1]-a[u][1][1])==0)
        return 1;
    if((a[u][1][0]-a[u][2][0])*(a[u][3][0]-a[u][2][0])+(a[u][1][1]-a[u][2][1])*(a[u][3][1]-a[u][2][1])==0)
        return 2;
    if((a[u][2][0]-a[u][3][0])*(a[u][1][0]-a[u][3][0])+(a[u][2][1]-a[u][3][1])*(a[u][1][1]-a[u][3][1])==0)
        return 3;
}
double dist(int x1,int y1,int x2,int y2)
{
    return sqrt((a[x1][y1][0]-a[x2][y2][0])*(a[x1][y1][0]-a[x2][y2][0])+(a[x1][y1][1]-a[x2][y2][1])*(a[x1][y1][1]-a[x2][y2][1]));
}
void spfa()
{
    for(int i=1;i<=n;i++)
        for(int j=1;j<=4;j++)
            dis[i][j]=1e9+7;
    for(int i=1;i<=4;i++)
    {
        dis[s][i]=0;
        tmp.x=s,tmp.y=i;
        q.push(tmp);
        b[s][i]=1;
    }
    while(!q.empty())
    {
        airp u=q.front();
        for(int i=1;i<=n;i++)
            if(i!=u.x)
                for(int j=1;j<=4;j++)
                    if(dis[i][j]>dis[u.x][u.y]+v*dist(u.x,u.y,i,j))
                    {
                        dis[i][j]=dis[u.x][u.y]+v*dist(u.x,u.y,i,j);
                        if(!b[i][j])
                        {
                            b[i][j]=1;
                            tmp.x=i,tmp.y=j;
                            q.push(tmp);
                        }
                    }
        for(int i=1;i<=4;i++)
            if(i!=u.y)
                if(dis[u.x][i]>dis[u.x][u.y]+t[u.x]*dist(u.x,u.y,u.x,i))
                {
                    dis[u.x][i]=dis[u.x][u.y]+t[u.x]*dist(u.x,u.y,u.x,i);
                    if(!b[u.x][i])
                    {
                        b[u.x][i]=1;
                        tmp.x=u.x,tmp.y=i;
                        q.push(tmp);
                    }
                }
        q.pop();
        b[u.x][u.y]=0;
    }
}
int main()
{
    scanf("%d",&T);
    while(T--)
    {
        scanf("%d%d%d%d",&n,&v,&s,&e);
        for(int i=1;i<=n;i++)
        {
            scanf("%d%d%d%d%d%d%d",&a[i][1][0],&a[i][1][1],&a[i][2][0],&a[i][2][1],&a[i][3][0],&a[i][3][1],&t[i]);
            int zhi=pd(i),rui1,rui2;
            for(int j=1;j<=3;j++)
                if(j!=zhi)
                    rui1=j;
            for(int j=1;j<=3;j++)
                if(j!=zhi&&j!=rui1)
                    rui2=j;
            a[i][4][0]=a[i][rui1][0]+a[i][rui2][0]-a[i][zhi][0],a[i][4][1]=a[i][rui1][1]+a[i][rui2][1]-a[i][zhi][1];
        }
        spfa();
        ans=1e9+7;
        for(int i=1;i<=4;i++)
            ans=min(ans,dis[e][i]);
        printf("%.1f\n",ans);
    }
    return 0;
}