B-Street

https://codeforces.com/gym/326694/problem/B

题意：
一个大矩形里有很多小矩形，走小矩形外计算距离，走小矩形内距离不计。
现在给出数据，要求计算从大矩形的下底边走到上底边需要的最短距离。

做法：
先将小矩形视为点，计算不同小矩形之间的最短距离，及小矩形到上下底边的距离。
再在构建的图上跑最短路算法。

特别需要注意的点（我在这里卡了一个多小时qwq）：
小矩形在异侧时，宽度和可能会超过大矩形的宽度，这时不再需要走对角，而是直接走高度距离差的直线

#include<bits/stdc++.h>
using namespace std;
struct square{
    double h1,h2,w,k;
}s[110];
struct node{
    int pos;
    double dis;
    bool operator <(const node &a)const{
        return dis>a.dis;
    }
};
struct edge{
    int u,v,nxt;
    double w;
}e[88000];
int head[11000];
int tot;
double dis[11000];
bool vis[11000];
void addedge(int u,int v,double w){
    e[tot].u=u;
    e[tot].v=v;
    e[tot].w=w;
    e[tot].nxt=head[u];
    head[u]=tot;
    tot++;
}
void init(){
    memset(s,0,sizeof s);
    memset(e,0,sizeof e);
    memset(head,-1,sizeof head);
    memset(vis,0,sizeof vis);
    for(int i=0;i<11000;i++)dis[i]=4e18;
    tot=0;
}
double gd(double x,double y){//输入横纵坐标之差，返回距离
    return sqrt(x*x+y*y);
}
int n;
double l,r; //l为大矩形的高，r为大矩形的宽
void solve(){
    init();
    double h,w,d,k; //h为小矩形的高，w为小矩形的宽，d为小矩形到出发线的距离，k为在左边还是右边
    cin>>n>>l>>r;
    //处理图
    for(int i=1;i<=n;i++){
        cin>>h>>w>>d>>k;
        s[i].h1=d;
        s[i].h2=d+h;
        s[i].k=k;
        s[i].w=w;
        addedge(0,i,s[i].h1);
        addedge(i,0,s[i].h1);
        addedge(i,n+1,l-s[i].h2);
        addedge(n+1,i,l-s[i].h2);
        for(int j=1;j<i;j++){
            if(s[i].k==s[j].k){ //在同侧，直接计算高度差
                double lo=min( abs(s[i].h2-s[j].h1) , abs(s[i].h1-s[j].h2) );//两方块之间距离
                addedge(i,j,lo);
                addedge(j,i,lo);
            }else{//在异侧，距离分四种情况
                if(r-s[i].w-s[j].w<0){//****宽度和超过大宽度，可以走直线（一定要注意，特别容易漏掉）
                    double lo=min( abs(s[i].h2-s[j].h1) , abs(s[i].h1-s[j].h2) );
                    addedge(i,j,lo);
                    addedge(j,i,lo);
                }else if(s[i].h2<s[j].h1){//i完全在j下方
                    double lo=gd( s[i].h2-s[j].h1 , r-s[i].w-s[j].w );//计算两顶点之间的距离
                    addedge(i,j,lo);
                    addedge(j,i,lo);
                }else if(s[i].h1>s[j].h2){//i完全在j上方
                    double lo=gd( s[i].h1-s[j].h2 , r-s[i].w-s[j].w );//计算两顶点之间的距离
                    addedge(i,j,lo);
                    addedge(j,i,lo);
                }else{//i与j有一部分在高度轴上重合
                    double lo=r-s[i].w-s[j].w;
                    addedge(i,j,lo);
                    addedge(j,i,lo);
                }
            }
        }
    }
    //跑djskra
    priority_queue<node>q;  //开一个优先队列（优先队列默认大根堆，记得在struct里面把小于变成大于）
    q.push(node{0,0});  //要刷新的起始点
    dis[0]=0;   //起始点到自己的距离设为0
    while(!q.empty()){  //union cost search
        node sign=q.top();  //弹出最小元素
        q.pop();
        int x=sign.pos; //当前节点的编号
        if(vis[x])continue;
        vis[x]=1;
        for(int i=head[x];i!=-1;i=e[i].nxt){    //以x的位置为跳跃点，刷新所有x能到的点与起始点的距离
            int y=e[i].v;   //当前节点能去的点
            double ds=e[i].w; //当前节点到能去的点的距离
            if(dis[y]>dis[x]+ds){   //如果距离变小，则刷新并进队列
                dis[y]=dis[x]+ds;
                if(!vis[y]) q.push(node{y,dis[y]});
            }
        }
    }
    printf("%.6lf\n",dis[n+1]);
}
int main(){
    freopen("street.in", "r", stdin);
    int t;
    cin>>t;
    while(t--){
        solve();
    }
    //system("pause");
    return 0;
}