codevs1041 Car的旅行路线 最短路dijkstra

题目描述 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
//关键是建图
#include<cstdio>
#include<iostream>
#include<cmath>
#include<cstring>
using namespace std;
struct node{
int x,y;
node(){}
node(int a,int b):x(a),y(b){}
node operator-(const node& t){return node(x-t.x,y-t.y);}
node operator+(const node& t){return node(x+t.x,y+t.y);}
}a[105][4];
int n,t[105],s,st,c;
double d[105][4];
inline double dis(node t,node tt){
return sqrt((tt.x-t.x)*(tt.x-t.x)+(tt.y-t.y)*(tt.y-t.y));
}
node find(node t1,node t2,node t3){
node ans;
double d1=dis(t1,t2),d2=dis(t2,t3),d3=dis(t1,t3),mx;
mx=max(d1,max(d2,d3));
if(mx==d1) return t1+t2-t3;
if(mx==d2) return t2+t3-t1;
return t1+t3-t2;
}
void dijkstra(int i){
int vis[104][4]={0};
memset(d,66,sizeof(d));
d[s][i]=0;
for(int ttt=1;ttt<=n*4;ttt++){
double mi=d[0][0];
int k1,k2;
for(int i=1;i<=n;i++)
for(int j=0;j<4;j++){
if(!vis[i][j]&&mi>d[i][j]){
mi=d[k1=i][k2=j];
}
}
vis[k1][k2]=1;
for(int i=1;i<=n;i++)
for(int j=0;j<4;j++)
if(!vis[i][j])
d[i][j]=min(d[i][j],d[k1][k2]+dis(a[k1][k2],a[i][j])*(i==k1?t[i]:c));
}
}
int main(){
ios::sync_with_stdio(false);
cin.tie(0);
int T;
cin>>T;
while(T--){
double ans=1e300;
cin>>n>>c>>s>>st;
for(int i=1;i<=n;i++){
cin>>a[i][0].x>>a[i][0].y>>a[i][1].x>>a[i][1].y>>a[i][2].x>>a[i][2].y>>t[i];
a[i][3]=find(a[i][0],a[i][1],a[i][2]);
}
for(int i=0;i<4;i++)
{
dijkstra(i);
ans=min(ans,min(min(d[st][0],d[st][1]),min(d[st][2],d[st][3])));
}
printf("%.1lf\n",ans);
}
return 0;
}