codevs 1041 Car 的旅行路线 最短路+代码能力

又到暑假了，住在城市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

用Floyd跑最短路，重点在处理第四点和处理两点之间花费。
比较恶心，直接贴代码

#include<iostream>
#include<cstdio>
#include<cmath>
using namespace std;
double dis[405][405];
long long pf(int x,int y)
{
    if(x>y)
        swap(y,x);
    return (y-x)*(y-x);
}
struct dian
{
    int x,y;
}dian[405];
int tot=1;
void Floyd(int n)
{
    for(int k=1;k<=n;k++)
    for(int i=1;i<=n;i++)
    for(int j=1;j<=n;j++)
        dis[i][j]=min(dis[i][j],dis[i][k]+dis[k][j]);
/*  for(int i=1;i<=n;i++)
    {
        for(int j=1;j<=n;j++)
            printf("%.1lf ",dis[i][j]);
        cout<<endl;
    }*/
}
int main()
{
    int n;scanf("%d",&n);
    while(n--)
    {
        int s,t,a,b;
        scanf("%d%d%d%d",&s,&t,&a,&b);
        int x1,y1,x2,y2,x3,y3,x4,y4,c;
        long long pf12,pf13,pf14,pf23,pf24,pf34,p1,p2,p3,p4;
        for(int i=1;i<=s;i++)
        {
            scanf("%d%d%d%d%d%d%d",&x1,&y1,&x2,&y2,&x3,&y3,&c);
            pf12=pf(x2,x1)+pf(y2,y1);
            pf23=pf(x3,x2)+pf(y3,y2);
            pf13=pf(x1,x3)+pf(y1,y3);
            if(pf12+pf23==pf13)
            {
                x4=x1+x3-x2;
                y4=y1+y3-y2;
            }
            if(pf12+pf13==pf23)
            {
                x4=x2+x3-x1;
                y4=y2+y3-y1;
            }
            if(pf13+pf23==pf12)
            {
                x4=x1+x2-x3;
                y4=y1+y2-y3;
            }
            dian[tot].x=x1;  dian[tot].y=y1;
            dian[tot+1].x=x2;dian[tot+1].y=y2;
            dian[tot+2].x=x3;dian[tot+2].y=y3;
            dian[tot+3].x=x4;dian[tot+3].y=y4;
            pf14=pf(x4,x1)+pf(y4,y1);
            pf24=pf(x4,x2)+pf(y4,y2);
            pf34=pf(x4,x3)+pf(y4,y3);
            dis[tot][tot+1]=((double)sqrt(pf12))*(double)c;
            dis[tot+1][tot]=dis[tot][tot+1];
            dis[tot][tot+2]=((double)sqrt(pf13))*(double)c;
            dis[tot+2][tot]=dis[tot][tot+2];
            dis[tot][tot+3]=((double)sqrt(pf14))*(double)c;
            dis[tot+3][tot]=dis[tot][tot+3];
            dis[tot+1][tot+2]=((double)sqrt(pf23))*(double)c;
            dis[tot+2][tot+1]=dis[tot+1][tot+2];
            dis[tot+1][tot+3]=((double)sqrt(pf24))*(double)c;
            dis[tot+3][tot+1]=dis[tot+1][tot+3];
            dis[tot+2][tot+3]=((double)sqrt(pf34))*(double)c;
            dis[tot+3][tot+2]=dis[tot+2][tot+3];
            for(int j=1;j<tot;j++)
            {
                p1=pf(x1,dian[j].x)+pf(y1,dian[j].y);
                dis[tot][j]=((double)sqrt(p1))*(double)t;
                dis[j][tot]=dis[tot][j];

                p2=pf(x2,dian[j].x)+pf(y2,dian[j].y);
                dis[tot+1][j]=((double)sqrt(p2))*(double)t;
                dis[j][tot+1]=dis[tot+1][j];

                p3=pf(x3,dian[j].x)+pf(y3,dian[j].y);
                dis[tot+2][j]=((double)sqrt(p3))*(double)t;
                dis[j][tot+2]=dis[tot+2][j];

                p4=pf(x4,dian[j].x)+pf(y4,dian[j].y);
                dis[tot+3][j]=((double)sqrt(p4))*(double)t;
                dis[j][tot+3]=dis[tot+3][j];
            }
            tot+=4;
        }
        Floyd(s*4);
        double ans=214748364;
        for(int i=(a-1)*4+1;i<=(a-1)*4+4;i++)
        for(int j=(b-1)*4+1;j<=(b-1)*4+4;j++)
            ans=min(ans,dis[i][j]);
        printf("%0.1lf\n",ans);
    }
}