算法训练 Car的旅行路线(蓝桥杯)

问题描述
　　又到暑假了，住在城市A的Car想和朋友一起去城市B旅游。她知道每个城市都有四个飞机场，分别位于一个矩形的四个顶点上，同一个城市中两个机场之间有一 条笔直的高速铁路，第I个城市中高速铁路了的单位里程价格为Ti，任意两个不同城市的机场之间均有航线，所有航线单位里程的价格均为t。
　　那么Car应如何安排到城市B的路线才能尽可能的节省花费呢?她发现这并不是一个简单的问题，于是她来向你请教。
　　找出一条从城市A到B的旅游路线，出发和到达城市中的机场可以任意选取，要求总的花费最少。
输入格式
　　的第一行有四个正整数s，t，A，B。
　　S表示城市的个数，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行，每行一个数据对应测试数据，保留一位小数。
样例输入
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
样例输出
47.55
数据规模和约定
　　0<S<=100

1. 利用矩形中心(两个对角线的中点)坐标，求得第四个点的坐标。
2. 生成所有边的权值。
3. 使用Dijsktra算法，注：使用之前，将出发城市的边两两权值赋值为0，相当于在出发城市任一个机场出发。

/*
问题描述
　　又到暑假了，住在城市A的Car想和朋友一起去城市B旅游。
她知道每个城市都有四个飞机场，分别位于一个矩形的四个顶点上，
同一个城市中两个机场之间有一 条笔直的高速铁路，
第I个城市中高速铁路了的单位里程价格为Ti，任意两个不同城市的机场之间均有航线，
所有航线单位里程的价格均为t。
　　那么Car应如何安排到城市B的路线才能尽可能的节省花费呢?
她发现这并不是一个简单的问题，于是她来向你请教。
　　找出一条从城市A到B的旅游路线，出发和到达城市中的机场可以任意选取，
要求总的花费最少。
输入格式的第一行有四个正整数s，t，A，B。
　　S表示城市的个数，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行，每行一个数据对应测试数据，保留一位小数。
样例输入
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
样例输出
47.55
数据规模和约定
*/
#include<iostream>
#include<vector>
#include<algorithm>
#include<cmath>
#include<cstdio>
using namespace std;
struct city{
	int x[4],y[4];
	int T;
	city(int a,int b,int c,int d,int e,int f,int g){
		x[0]=a;x[1]=b;x[2]=c;y[0]=d;y[1]=e;y[2]=f;
		T=g;
	}
};
vector<city> v;
int s,t,a,b;
double len[405][405];//边权值 
double dis[405];//到源点的距离
int path[405];//路径 

void get(int i){
	int e1=(v[i].x[0]-v[i].x[1])*(v[i].x[0]-v[i].x[1])+(v[i].y[0]-v[i].y[1])*(v[i].y[0]-v[i].y[1]);//12
	int e2=(v[i].x[0]-v[i].x[2])*(v[i].x[0]-v[i].x[2])+(v[i].y[0]-v[i].y[2])*(v[i].y[0]-v[i].y[2]);//13
	int e3=(v[i].x[2]-v[i].x[1])*(v[i].x[2]-v[i].x[1])+(v[i].y[2]-v[i].y[1])*(v[i].y[2]-v[i].y[1]);//23
	int max_e=max(e1,max(e2,e3));
	int X1,X2,Y1,Y2;//斜边上点坐标 
	if(e1==max_e){
		X1=v[i].x[0];X2=v[i].x[1]; 
		Y1=v[i].y[0];Y2=v[i].y[1];
	}else if(e2==max_e){
		X1=v[i].x[0];X2=v[i].x[2]; 
		Y1=v[i].y[0];Y2=v[i].y[2];
	}else{
		X1=v[i].x[1];X2=v[i].x[2]; 
		Y1=v[i].y[1];Y2=v[i].y[2];	
	}
	v[i].x[3]=X1+X2-(v[i].x[0]+v[i].x[1]+v[i].x[2]-X1-X2);
	v[i].y[3]=Y1+Y2-(v[i].y[0]+v[i].y[1]+v[i].y[2]-Y1-Y2);
}
void get_edge(){
	for(int i=0;i<s*4;++i){
		for(int j=i;j<s*4;++j){
			int c1=i/4;int c2=j/4;//城市编号 
			int num1=i%4,num2=j%4;//机场编号 
			int delta_x=v[c1].x[num1]-v[c2].x[num2];
			int delta_y=v[c1].y[num1]-v[c2].y[num2];
			//if(len[i][j]==-1)
			if(c1==c2){
				//在同一个城市
				len[i][j]=len[j][i]=sqrt(delta_x*delta_x+delta_y*delta_y)*v[c1].T;
				//cout<<len[i][j]<<" "; 
			}else{
				len[i][j]=len[j][i]=sqrt(delta_x*delta_x+delta_y*delta_y)*t;
				//cout<<len[i][j]<<" "; 
			}
		}
	}
}
void Dijsktra(int start,int end){
	bool S[405]={false};
	S[start*4]=true;
	dis[start*4]=0;
	for(int i=start*4;i<=start*4+3;++i){
		for(int j=i;j<=start*4+3;++j)
			len[i][j]=len[j][i]=0;	
	}
	
	for(int i=0;i<s*4;++i){
		dis[i]=len[i][start*4];
	}
		
	//寻找距离最近的那一个点
	int u;
	for(int j=1;j<=s*4-1;++j){
	double mindis=1<<20;
	for(int i=0;i<s*4;++i){
		if(S[i]==false&&dis[i]<mindis){
			u=i;mindis=dis[u];
		}
	}
	S[u]=true;//加入s集合
	//更新最短路径 
	for(int i=0;i<s*4;++i){
		if(S[i]==false){
			dis[i]=(dis[i]>(dis[u]+len[i][u]))?dis[u]+len[i][u]:dis[i];
		}
	} 
	}
	//求得最小值 
	double ans=dis[end*4];
	for(int j=end*4+1;j<=end*4+3;++j){
		if(dis[j]<ans)
			ans=dis[j];
	}
	printf("%.2lf",ans);
}
int main(){
	cin>>s>>t>>a>>b;
	for(int i=0;i<s;++i){
		int x1,x2,x3,y1,y2,y3,tt;
		cin>>x1>>y1>>x2>>y2>>x3>>y3>>tt;
		v.push_back(city(x1,x2,x3,y1,y2,y3,tt));
		get(i);//得到第四个点的坐标 
	} 
	//城市号记得加一
	get_edge();//得到所有边的权值
	Dijsktra(a-1,b-1); //输出a到b的最短路 
	return 0;
}