【CodeVS】P1041 car的旅行路线

题目描述 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

数据范围及提示 Data Size & Hint

如描述

思路分析:求出第四个点，一开始感觉什么高大上呢，其实就是勾股定理，三种情况，稍微注意下存边，再加上最短路就好，做了半天，当在同一城市时火车的价钱打成了机场的，卡了好久MD，加强静态查错能力。。

PS：基本上是看了（http://wenku.baidu.com/link?url=n3hmdiEGTq9j-cBOP7ZUC7t6Ea8FwG6vbrFDTeKhe5hi_x3flKpzelERXByhlQ2gbj7kzJXyZBwSkgAPIxISrkDzIp5bEl0oI9aP5tWbc-a），讲得很好。

Source:

 #include <iostream>
 #include <cstdio>
 #include <cmath>
 #include <cstring>
 #include <algorithm>
 using namespace std;
 int n,vf,start,end,s;
 int map[][],vn[];
 bool used[];
 double ans[];
 double dist(int x1,int y1,int x2,int y2)
 {
     return (sqrt(pow((x1-x2),)+pow((y1-y2),)));
 }
 void dijistra()//dijistra求最短路 。
 {
     int i,j,now,apt;
     double minn,u;
     memset(used,,sizeof(used));
     memset(ans,,sizeof(ans));
     minn=;
     used[start*]=true;
     used[start*-]=true;
     used[start*-]=true;
     used[start*-]=true;
     while (==)
     {
         minn=;
     for (i=;i<=*n;i++)//枚举被经过的机场，对其余未被经过的机场进行dijstra。
     {
         if (used[i])
         {
             now=(i-)/+;
             for (j=;j<=*now-;j++)// 若未被经过的机场dis值最小的在当前最短路的机场所在城市"前面",枚举所在城市的前面的机场。
             {
                 if (!used[j])
                 {
                     u=ans[i]+dist(map[i][],map[i][],map[j][],map[j][])*vf;
                     if (u<minn)
                     {
                         minn=u;
                         apt=j;//记录机场位置
                     }
                 }
             }

             for (j=*now-;j<=*now;j++)//若未被经过的机场dis值最小的和当前最短路的机场处于同一个城市，换交通方式。
             {
                 if (!used[j])
                 {
                     u=ans[i]+dist(map[i][],map[i][],map[j][],map[j][])*vn[now];
                     if (u<minn)
                     {
                         minn=u;
                         apt=j;
                     }
                 }
             }
             for (j=*now+;j<=*n;j++)//同第一种情况。
             {
                 if (!used[j])
                 {
                     u=ans[i]+dist(map[i][],map[i][],map[j][],map[j][])*vf;
                     if (u<minn)
                     {
                         minn=u;
                         apt=j;
                     }
                 }
             }

         }
     }
         if ((apt==*end-) || (apt==*end-) || (apt==*end-) || (apt==*end))
         {
             printf("%.1lf\n",minn);
             return;
         }
         else
         {
             used[apt]=true;

             ans[apt]=minn;
         }
 //    }
     }
 }
 void rf()//读入+根据平面内三点，求出第四个点的坐标。
 {
     int i;
     int x,x1,x2,x3,y1,y2,y3,y;
     scanf("%d%d%d%d",&n,&vf,&start,&end);
     if (start==end)
         {
             printf("%.1lf",0.0);
             return;
         }
     else
     for (i=;i<=n;i++)
     {
         scanf("%d%d%d%d%d%d%d",&x1,&y1,&x2,&y2,&x3,&y3,&vn[i]);
         x=x1+x2-x3; y=y1+y2-y3;
         if (dist(x1,y1,x2,y2)!=dist(x3,y3,x,y))
         {
             x=x1+x3-x2;
             y=y1+y3-y2;
             if (dist(x1,y1,x3,y3)!=dist(x2,y2,x,y))
             {
                 x=x2+x3-x1;
                 y=y2+y3-y1;
             }
         }
         map[i*-][]=x1; map[i*-][]=y1;
         map[i*-][]=x2; map[i*-][]=y2;
         map[i*-][]=x3; map[i*-][]=y3;
         map[i*][]=x;     map[i*][]=y;
     }
     dijistra();
 }

 int main()
 {
     int i;
     scanf("%d",&s);
     for (i=;i<=s;i++)
     {
     memset(map,,sizeof(map));
     //memset(ans,0,sizeof(ans));
     rf();
     }
     return ;
 }