P1354 房間最短路問題

纯粹的發表於2024-03-29

原題連結

題解

1.最短路徑一定可以表示成經過若干端點的線段,所以我們把端點單獨提出來,這樣就變成了計算幾何形式的最短路
2.如果兩個端點能相連,代表他們之間沒有牆阻擋

code

#include<bits/stdc++.h>
using namespace std;
int n;

struct
{
    double x,a1,b1,a2,b2;
}wall[30];

int cnt=0;
struct
{
    double x,y;
}node[100];

vector<int> G[100];

void add(double x,double y)
{
    node[++cnt].x=x;
    node[cnt].y=y;
}

int disturb(int a,int b)//判斷兩點之間有沒有被阻擋
{
    double x1=node[a].x,x2=node[b].x,y1=node[a].y,y2=node[b].y;
    double k=(y2-y1)/(x2-x1);

    for(int i=1;i<=n;i++)
    {
        if(wall[i].x<=x1||wall[i].x>=x2) continue;

        double y3=k*(wall[i].x-x1)+y1;
        //printf("node:%d,%d   wall:%d  y:%.2lf\n",a,b,i,y3);
        if(wall[i].a1<=y3&&y3<=wall[i].b1||wall[i].a2<=y3&&y3<=wall[i].b2) continue;
        else return 1;
    }
    return 0;
}
double cal(int a,int b)
{
    return sqrt((node[a].x-node[b].x)*(node[a].x-node[b].x)+(node[a].y-node[b].y)*(node[a].y-node[b].y));
}

struct fresh
{
    int id;
    double val;
    bool operator<(const fresh &b) const {return b.val<val;}
};

int main()
{
    cin>>n;
    add(0,5);
    for(int i=1;i<=n;i++)
    {
        cin>>wall[i].x>>wall[i].a1>>wall[i].b1>>wall[i].a2>>wall[i].b2;
        double x=wall[i].x;
        add(x,wall[i].a1);//單獨提出來
        add(x,wall[i].b1);
        add(x,wall[i].a2);
        add(x,wall[i].b2);
    }
    add(10,5);
    for(int i=1;i<cnt;i++)
    {
        for(int j=i+1;j<=cnt;j++)
        {
            if(node[i].x==node[j].x) continue;
            if(!disturb(i,j)) G[i].push_back(j);//建邊
        }
    }

    /*for(int i=1;i<=cnt;i++)
    {
        printf("%d:  ",i);
        for(auto it:G[i]) cout<<it<<" ";
        puts("");
    }*/

    double dis[100];

    for(int i=1;i<=cnt;i++) dis[i]=2e9;

    priority_queue<fresh> q;
    q.push({1,0});//最短路
    while(q.size())
    {
        int now=q.top().id;
        double val=q.top().val;
        q.pop();
        if(dis[now]<=val) continue;
        dis[now]=val;
        for(auto next:G[now])
        {
            double dist=cal(now,next);
            if(dist+dis[now]<dis[next]) q.push({next,dis[now]+dist});
        }
    }
    //for(int i=1;i<=cnt;i++) printf("%d : %.2lf\n",i,dis[i]);
    printf("%.2lf",dis[cnt]);
    return 0;
}

相關文章