Car的旅行路线

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

第一行有四个正整数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个城市高速铁路单位里程的价格。
输出格式
输出最小费用(结果保留两位小数)
样例输入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

#include<cstdio>
#include<cmath>
#include<cstring>
#include<iostream>
using namespace std;
int tx[505],ty[505],n;
int s,t,A,B,xi1,xi2,xi3,yi1,yi2,yi3,tt;
int num;
double ans,a[1001][1001];
int pow(int x)
{
    return (x*x);
}
void work(int u)
{
    int max1=-1;
    int x,y,z;
    a[num][num-1]=a[num-1][num]=sqrt(pow(tx[num]-tx[num-1])+pow(ty[num]-ty[num-1]))*u;
    if (max1<a[num][num-1])
    {
        max1=a[num][num-1];
        x=num;
        y=num-1;
        z=num-2;
    }
    a[num-1][num-2]=a[num-2][num-1]=sqrt(pow(tx[num-1]-tx[num-2])+pow(ty[num-1]-ty[num-2]))*u;
    if (max1<a[num-1][num-2])
    {
        max1=a[num-1][num-2];
        x=num-1;
        y=num-2;
        z=num;
    }
    a[num][num-2]=a[num-2][num]=sqrt(pow(tx[num]-tx[num-2])+pow(ty[num]-ty[num-2]))*u;
    if (max1<a[num][num-2])
    {
        max1=a[num][num-2];
        x=num;
        y=num-2;
        z=num-1;
    }

    tx[++num]=tx[x]-tx[z]+tx[y];
    ty[num]=ty[x]-ty[z]+ty[y];

    a[num][x]=a[x][num]=a[y][z];
    a[num][y]=a[y][num]=a[x][z];
    a[num][z]=a[z][num]=a[x][y];
}
double qiu(int heng,int ha)
{
    return sqrt(pow(tx[heng]-tx[ha])+pow(ty[heng]-ty[ha]));
}
int main()
{
//  freopen("car.in","r",stdin);
//  freopen("car.out","w",stdout);

    scanf("%d",&n);
    while (n>0)
    {
        n--;
    scanf("%d%d%d%d",&s,&t,&A,&B);
//  memset(tx,0,sizeof(tx));
//  memset(ty,0,sizeof(ty));
    memset(a,0,sizeof(a));
    num=0;
    for (int i=1;i<=s;i++)
    {
        scanf("%d%d",&xi1,&yi1);
        tx[++num]=xi1; ty[num]=yi1;
        scanf("%d%d",&xi2,&yi2);
        tx[++num]=xi2; ty[num]=yi2;
        scanf("%d%d",&xi3,&yi3);
        tx[++num]=xi3; ty[num]=yi3;
        scanf("%d",&tt);
        work(tt);
    }




    ans=100000000.0;
    for (int k=1;k<=s*4;k++)
      for (int i=1;i<=s*4;i++)
        for (int j=1;j<=s*4;j++)

        {
            if (a[i][j]==0)
                a[i][j]=qiu(i,j)*t;
            if (a[i][k]==0)
              a[i][k]=qiu(i,k)*t;
            if (a[k][j]==0)
              a[k][j]=qiu(k,j)*t;


            if (a[i][j]>a[i][k]+a[k][j])
            {
                 a[i][j]=a[i][k]+a[k][j];
            }

            if ((i-1)/4==A-1&&(j-1)/4==B-1)
                ans=min(ans,a[i][j]);
        }

    printf("%.1lf\n",ans);
    }
}