洛谷 P2452 [SDOI2005]屠龙传说-屠龙枪卷 [计算几何]

题目连接

就一个所点与延展的算计基本题，主要是eps很迷，SDOI防AC题，线下70分，线上0分，暂且发一下垃圾code

#include<cmath>#include<queue>#include<cstdio>#include<vector>#include<cstring>#include<iostream>#include<algorithm>using namespace std;//此算法有毒，只是为了得点暴力分。 const int N=20000;const double eps=1e-10;const double PI=acos(-1.0);struct data{//所有的向量以点表示法，节省变量声明。     double x,y;    data(){}    data(double x,double y):x(x),y(y){}};data operator+(data A,data B){//基础点值运算     return data(A.x+B.x,A.y+B.y);}data operator-(data A,data B){    return data(A.x-B.x,A.y-B.y);}struct Seg{//线段可表示为两端点的连线。     data A,B;    Seg(){}    Seg(data A,data B):A(A),B(B){}};struct Line{//用点值+方向（法度）表示法     double a,b,c;    Line(){}    Line(data A,data B){a=B.y-A.y;b=A.x-B.x;c=(B.x-A.x)*A.y-(B.y-A.y)*A.x;}};struct Cir{//点+半径     data c;    double r;    Cir(){}    Cir(data c,double r):c(c),r(r){}};int n,tot,cnt,flag,vis[N];double x,y,a,r,angle,d,dis[N];data s,t,u,V[N];//V记录相邻特判点。 Seg S[N];//Edge Line A,B;Cir C[N];//圆 vector<int>G[N];//to[] vector<double>val[N];//val[]inline int judge(double x){//关键--eps不好卡     return fabs(x)<eps?0:(x>0?1:-1);}inline double Dot(data A,data B){//点乘     return A.x*B.x+A.y*B.y;}inline double Cross(data A,data B){//叉乘     return A.x*B.y-A.y*B.x;}inline double Length(data A){//离原点距离     return sqrt(Dot(A,A));}inline double Angle(data A,data B){//cos方向 高一上册。。。     return acos(Dot(A,B)/(Length(A)*Length(B)));}inline double dist(data A,data B){//尽量少用sqrt     return sqrt((A.x-B.x)*(A.x-B.x)+(A.y-B.y)*(A.y-B.y));}inline bool OnCir(data p,Cir c){//在圆上？     return judge(dist(p,c.c)-c.r)==0;}inline data rotate(data A,double rad){//对边旋转。     return data(A.x*cos(rad)-A.y*sin(rad),A.x*sin(rad)+A.y*cos(rad));}inline bool JX(Seg A,Seg B){//线段判定，是否有障碍阻挡     return judge((Cross(A.B-A.A,B.A-A.A))*(Cross(A.B-A.A,B.B-A.A)))<0         &&judge((Cross(B.B-B.A,A.A-B.A))*(Cross(B.B-B.A,A.B-B.A)))<0;}inline data JP(Line A,Line B){//两直线交点     return data((B.c*A.b-A.c*B.b)/(A.a*B.b-B.a*A.b),(B.a*A.c-A.a*B.c)/(A.a*B.b-B.a*A.b));}inline bool CrCir(Seg A,Cir C){//对圆求切线     Line p,q;data u;data t;double d;    u=A.A-A.B;u=rotate(u,PI/2.0);    p=Line(A.A,A.B);q=Line(C.c,C.c+u);    t=JP(p,q);    if (judge(dist(A.A,t)+dist(A.B,t)-dist(A.A,A.B))!=0)d=min(dist(A.A,C.c),dist(A.B,C.c));    else d=dist(C.c,t);    return judge(d-C.r)<0?1:0;}inline void SPFA(){//板子     queue<int>q;    memset(vis,0,sizeof(vis));    memset(dis,0x7f,sizeof(dis));    vis[1]=1;dis[1]=0.0;q.push(1);    while(!q.empty()){        int u=q.front();q.pop();vis[u]=0;        for(register int i=0;i<G[u].size();i++){            if(dis[u]+val[u][i]<dis[G[u][i]]){                dis[G[u][i]]=dis[u]+val[u][i];                if(!vis[G[u][i]]){                    vis[G[u][i]]=1;                    q.push(G[u][i]);                }            }        }    }}inline void INsert(data k,int i){    angle=fabs(asin(C[i].r/dist(k,C[i].c)));    u=C[i].c-k;u=rotate(u,angle);A=Line(k,k+u);    B=Line(C[i].c,C[i].c+rotate(u,PI/2.0));    V[++cnt]=JP(A,B);    u=C[i].c-k;u=rotate(u,-angle);A=Line(k,k+u);    B=Line(C[i].c,C[i].c+rotate(u,PI/2.0));    V[++cnt]=JP(A,B);}inline void Addedge(int x,int y,double d){    G[x].push_back(y),G[y].push_back(x);    val[x].push_back(d),val[y].push_back(d);}int main(){    freopen("dragon.in","r",stdin);    freopen("dragon.out","w",stdout);    scanf("%lf%lf%lf%lf%lf",&s.x,&s.y,&r,&t.x,&t.y);    scanf("%d",&n);    for(register int i=1;i<=n;i++){        scanf("%lf%lf%lf",&x,&y,&a);//动点转静态延伸         S[++tot]=Seg(data(x,y-r),data(x+a,y-r));//四角延伸r，圆缩点。         C[tot]=Cir(data(x,y),r);        S[++tot]=Seg(data(x+a+r,y),data(x+a+r,y+a));        C[tot]=Cir(data(x+a,y),r);        S[++tot]=Seg(data(x+a,y+a+r),data(x,y+a+r));        C[tot]=Cir(data(x+a,y+a),r);        S[++tot]=Seg(data(x-r,y+a),data(x-r,y));        C[tot]=Cir(data(x,y+a),r);    }    V[++cnt]=s;V[++cnt]=t;    for(register int i=1;i<=tot;i++){//判定是否有特殊情况         if(!OnCir(s,C[i]))INsert(s,i);//出入若在扩展圆内，特判重构。         if(!OnCir(t,C[i]))INsert(t,i);    }    for(register int i=1;i<=cnt;i++){        for(register int j=i+1;j<=cnt;j++){            flag=1;            for(register int k=1;k<=tot;k++){//切线与公切线                 if(JX(Seg(V[i],V[j]),S[k])||CrCir(Seg(V[i],V[j]),C[k]))flag=0;                if(OnCir(V[i],C[k])&&OnCir(V[j],C[k])){                    d=Angle(V[i]-C[k].c,V[j]-C[k].c)*C[k].r;                    Addedge(i,j,d);//若有障碍则拆边重构成两条边。                 }            }            if(flag)Addedge(i,j,dist(V[i],V[j]));        }    }    SPFA();//虽暴力拆边，但由于障碍性质，SPFA还是优一点。     printf("%.2lf\n",dis[2]);//算法问题所在：起点or终点被大量点所包围。     return 0;//夹缝式数据可卡。 }//总计2.3小时。。