luogu P1354 房间最短路问题 最短路

不是自己写的代码，但是帮忙d了挺久...

很直观的想法，如果把起点，终点，和所有的墙的边界点看作点的话，最终的最短路径一定只经过这些点，把图建出来，跑一边最短路即可。

#include<cstdio>
#include<queue>
#include<iostream>
#include<cstring>
#include<algorithm>
#include<cmath>
using namespace std;
#define maxn 50000
const double inf=99999999.;
priority_queue<pair<double,int> > Q;
struct node
{
    double x;
    double y[10];
} p[maxn];
int head[maxn],to[maxn],nxt[maxn];
double w[maxn],dis[maxn];
bool vis[maxn];
int n,tot,cnt;
void add(int a,int b,double val)
{
    to[++cnt]=b;
    nxt[cnt]=head[a];
    head[a]=cnt;
    w[cnt]=val;
}
bool check(double x,double y,int now,int to,int whi)
{
    if(to-now<=1) return 1;
    double k=(p[to].y[whi]-y)/(p[to].x-x);
    double B=y-k*x;

    for(int i=now+1; i<=to-1; i++)
    {
        double ny=k*p[i].x+B;
        if(ny>p[i].y[3]||ny<p[i].y[0]||(ny>p[i].y[1]&&ny<p[i].y[2]))
            return 0;
    }
    return 1;
}
double find(double x,double y,double a,double b)
{
    return sqrt((x-a)*(x-a)+(y-b)*(y-b));
}
void solve()
{
    for(int i=1; i<=tot; i++)
    {
        for(int j=0; j<=3; j++)
        {
            if(check(0,5,0,i,j))
            {
                if(p[i].x==0) continue;
                add(0,(i-1)*4+j+1,find(0,5,p[i].x,p[i].y[j]));
            }
        }
    }
    for(int i=1; i<=tot; i++)
        for(int o=0; o<=3; o++)
            for(int j=i+1; j<=tot; j++)
                for(int k=0; k<=3; k++)
                    if(check(p[i].x,p[i].y[o],i,j,k))
                    {
                        if(p[i].x==p[j].x) continue;
                        add((i-1)*4+o+1,(j-1)*4+k+1,find(p[i].x,p[i].y[o],p[j].x,p[j].y[k]));
                    }
}
void DJ()
{
    dis[0]=0;
    Q.push(make_pair(0,0));
    while(!Q.empty())
    {
        int u=Q.top().second;
        Q.pop();
        if(vis[u]||dis[u]==inf) continue;
        vis[u]=1;
        for(int i=head[u]; i; i=nxt[i])
        {
            int v=to[i];
            if(dis[v]>dis[u]+w[i])
            {
                dis[v]=dis[u]+w[i];
                Q.push(make_pair(-dis[v],v));
            }
        }
    }
}
int main()
{
    scanf("%d",&n);
    for(int i=0; i<=n*4+1; i++)
        dis[i]=inf;
    for(int i=1; i<=n; i++)
    {
        double x,a,b,c,d;
        scanf("%lf%lf%lf%lf%lf",&x,&a,&b,&c,&d);
        p[++tot].x=x;
        p[tot].y[0]=a;
        p[tot].y[1]=b;
        p[tot].y[2]=c;
        p[tot].y[3]=d;
    }
    p[++tot].x=10;
    for(int i=1; i<=3; i++) p[tot].y[i]=99999999.9;
    p[tot].y[0]=5;
    solve();
    DJ();
    printf("%.2lf
",dis[4*n+1]);
    return 0;
}