Vijos - Car的旅行路线(最短路)

题目链接:https://vijos.org/p/1119

题目描述

又到暑假了，住在城市A的Car想和朋友一起去城市B旅游。她知道每个城市都有四个飞机场，分别位于一个矩形的四个顶点上，同一个城市中两个机场之间有一条笔直的高速铁路，第I个城市中高速铁路了的单位里程价格为Ti，任意两个不同城市的机场之间均有航线，所有航线单位里程的价格均为t。

那么Car应如何安排到城市B的路线才能尽可能的节省花费呢?她发现这并不是一个简单的问题，于是她来向你请教。找出一条从城市A到B的旅游路线，出发和到达城市中的机场可以任意选取，要求总的花费最少。

输入格式

第一行有四个正整数S，T，A，B。其中S(0 接下来有S行，其中第I行均有7个正整数xi1，yi1，xi2，yi2，xi3，yi3，Ti，这当中的(xi1，yi1)，(xi2，yi2)，(xi3，yi3)分别是第I个城市中任意三个机场的坐标，T I为第I个城市高速铁路单位里程的价格。

输出格式

输出最小费用(结果保留两位小数)

样例输入

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

解题思路

这个就是一道最短路问题，关键的就是已知矩形三个点的坐标，求出最后一个点的坐标，只要求出这个，剩下的就好做了，这是本人写的求法：https://blog.csdn.net/lzyws739307453/article/details/85008349

求出四个点的坐标之后，题上说共有S个城市，那么我们可以得到4*S个点(每个城市4个点)，然后分别求出一个点到其余各点的花费，城市四个点之间的按高铁的价格算，城市与城市按飞机的价格算，跑一遍最短路，最后求出A城市的四个点分别到B城市的四个点的最小花费，求出最小值即可。

#include 
#include 
#include 
#include 
using namespace std;
const double inf = 999999999;
typedef struct edge {
    int x, y;
}coor;
coor e[450];
int vis[410];
double dis[410], map[410][410];
coor coordinate(coor a, coor b, coor c)
{
    coor p;
    p.x = b.x + c.x - a.x;
    p.y = b.y + c.y - a.y;
    return p;
}
bool Judge(coor a, coor b, coor c)
{
    if (!((b.x - a.x) * (c.x - a.x) + (b.y - a.y) * (c.y - a.y)))
        return true;
    return false;
}
void Seeking(coor a[])
{
    if (Judge(a[0], a[1], a[2]))
        a[3] = coordinate(a[0], a[1], a[2]);
    else if(Judge(a[1], a[0], a[2]))
        a[3] = coordinate(a[1], a[0], a[2]);
    else a[3] = coordinate(a[2], a[0], a[1]);
}
void Spfa(int s, int S)
{
    queue  Q;
    for (int i = 0; i < 4 * S; i++)
    {
        vis[i] = 0;
        dis[i] = inf;
    }
    Q.push(s);
    dis[s] = 0;
    vis[s] = 1;
    while (!Q.empty())
    {
        int u = Q.front();
        Q.pop();
        vis[u] = 0;
        for (int j = 0; j < 4 * S; j++)
        {
            if (dis[j] > dis[u] + map[u][j])
            {
                dis[j] = dis[u] + map[u][j];
                if (!vis[j])
                {
                    vis[j] = 1;
                    Q.push(j);
                }
            }
        }
    }
}
int main()
{
    coor a, b;
    int S, T, A, B, TT[410];
    while (~scanf("%d%d%d%d", &S, &T, &A, &B))
    {
        double minn = inf;
        for (int i = 0; i < 4 * S; i++)
            for (int j = 0; j < 4 * S; j++)
                map[i][j] = inf;
        for (int i = 0; i < 4 * S; i += 4)
        {
            for (int j = 0; j < 3; j++)
                scanf("%d%d", &e[i + j].x, &e[i + j].y);
            scanf("%d", &TT[i]);
            Seeking(e + i);
        }
        for (int i = 0; i < 4 * S; i += 4)
        {
            for (int j = 0; j < 4; j++)
            {
                a = e[i + j];
                for (int k = i + j + 1; k < i + 4; k++)
                {
                    b = e[k];
                    map[k][i + j] = map[i + j][k] = TT[i] * sqrt((a.x - b.x) * (a.x - b.x) + (a.y - b.y) * (a.y - b.y));
                }
                for (int k = i + 4; k < 4 * S; k++)
                {
                    b = e[k];
                    map[k][i + j] = map[i + j][k] = T * sqrt((a.x - b.x) * (a.x - b.x) + (a.y - b.y) * (a.y - b.y));
                }
            }
        }
        for (int i = 0; i < 4; i++)
        {
            int u = (A - 1) * 4 + i;
            Spfa(u, S);
            for (int j = 0; j < 4; j++)
            {
                int v = (B - 1) * 4 + j;
                if (minn > dis[v])
                    minn = dis[v];
            }
        }
        printf("%.2lf\n", minn);
    }
    return 0;
}