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个城市高速铁路单位里程的价格。

解题思路：

首先最多400个点的图，用哪种求最短路的方法都可以，我这里选用了spfa；

1：给出了每一个城市的三个机场坐标，需要求出最后一个坐标，方法如下

void find(node &a)
{
	if(((a.x[1]-a.x[0])*(a.x[2]-a.x[0])+(a.y[1]-a.y[0])*(a.y[2]-a.y[0]))==0)
	{
		a.x[3]=a.x[1]+a.x[2]-a.x[0];
		a.y[3]=a.y[1]+a.y[2]-a.y[0];
	}
	else if(((a.x[0]-a.x[1])*(a.x[2]-a.x[1])+(a.y[0]-a.y[1])*(a.y[2]-a.y[1]))==0)
	{
		a.x[3]=a.x[0]+a.x[2]-a.x[1];
		a.y[3]=a.y[0]+a.y[2]-a.y[1];
	}
	else
	{
		a.x[3]=a.x[0]+a.x[1]-a.x[2];
		a.y[3]=a.y[0]+a.y[1]-a.y[2];
	}
}

2：构图，站点内部不同机场连边，不同城市的机场连边；

3：可以弄一个起始点连接A，路程为0；一个结束点连接B，路程为0，这样就可以方便处理最短路。

代码如下：

#include<cstdio>
#include<cstring>
#include<cmath>
#include<algorithm>
#include<queue>
using namespace std;
#define maxn 200000
#define inf 0x3f3f3f3f
struct node
{
	double x[4],y[4];
	int note[4];
	double w;
};
double dis(node a,int u,node b,int v)
{
	return sqrt((a.x[u]-b.x[v])*(a.x[u]-b.x[v])+(a.y[u]-b.y[v])*(a.y[u]-b.y[v]));
}
struct Edge
{
    int v;
    double w;
    int next;
}edge[3*maxn];
int head[maxn],vis[maxn],cnt,n,Max,Min;
double d[maxn];
int cnn;
int s,tt,a,b;
void addedge(int u,int v,double w)
{
    edge[cnt].v=v;
    edge[cnt].w=w;
    edge[cnt].next=head[u];
    head[u]=cnt++;
}
void spfa()
{
    for(int i=Min;i<=Max;i++) d[i]=inf;
    d[Min]=0;
    queue<int >q;
    while(!q.empty()) q.pop();
    q.push(Min);
    while(!q.empty())
    {
        int x=q.front();
        vis[x]=0;
        q.pop();
        for(int e=head[x];e!=-1;e=edge[e].next)
        if(d[edge[e].v]>d[x]+edge[e].w)
        {
            d[edge[e].v]=d[x]+edge[e].w;
            if(!vis[edge[e].v])
            {
                q.push(edge[e].v);
                vis[edge[e].v]=1;
            }
        }
    }
}
void find(node &a)
{
	if(((a.x[1]-a.x[0])*(a.x[2]-a.x[0])+(a.y[1]-a.y[0])*(a.y[2]-a.y[0]))==0)
	{
		a.x[3]=a.x[1]+a.x[2]-a.x[0];
		a.y[3]=a.y[1]+a.y[2]-a.y[0];
	}
	else if(((a.x[0]-a.x[1])*(a.x[2]-a.x[1])+(a.y[0]-a.y[1])*(a.y[2]-a.y[1]))==0)
	{
		a.x[3]=a.x[0]+a.x[2]-a.x[1];
		a.y[3]=a.y[0]+a.y[2]-a.y[1];
	}
	else
	{
		a.x[3]=a.x[0]+a.x[1]-a.x[2];
		a.y[3]=a.y[0]+a.y[1]-a.y[2];
	}
}
void init()
{
    memset(vis,0,sizeof(vis));
    memset(head,-1,sizeof(head));
    memset(edge,0,sizeof(edge));
    cnt=0;
    Min=0;
    cnn=1;
}
void addin(node a)
{
	for(int i=0;i<4;i++)
	{
		for(int j=0;j<4;j++)
		{
			if(i!=j)
			addedge(a.note[i],a.note[j],a.w*dis(a,i,a,j));
			addedge(a.note[j],a.note[i],a.w*dis(a,j,a,i));
		}
	}
}
void addout(node a,node b)
{
	for(int i=0;i<4;i++)
	{
		for(int j=0;j<4;j++)
		{
			addedge(a.note[i],b.note[j],tt*dis(a,i,b,j));
			addedge(b.note[j],a.note[i],tt*dis(a,i,b,j));
		}
	}
}
void addbegin(node a)
{
	for(int i=0;i<4;i++)
	{
		addedge(0,a.note[i],0);
		addedge(a.note[i],0,0);
	}
}
void addend(node a)
{
	for(int i=0;i<4;i++)
	{
		addedge(cnn,a.note[i],0);
		addedge(a.note[i],cnn,0);
	}
}
int main()
{
	init();
	scanf("%d%d%d%d",&s,&tt,&a,&b);
	node point[110];
	
	for(int i=1;i<=s;i++)
	{
		scanf("%lf%lf%lf%lf%lf%lf%lf",&point[i].x[0],&point[i].y[0],&point[i].x[1],&point[i].y[1],&point[i].x[2],&point[i].y[2],&point[i].w);
		find(point[i]);
		for(int j=0;j<4;j++)
		point[i].note[j]=cnn++;
		addin(point[i]);
	}
	Max=cnn;
	for(int i=1;i<=s;i++)
	{
		for(int j=1;j<=s;j++)
		{
			if(i!=j)
			{
				addout(point[i],point[j]);
			}
		}
	}
	addbegin(point[a]);
	addend(point[b]);
	spfa();
	printf("%.1lf",d[cnn]);
}