POJ 1584 A Round Peg in a Ground Hole

#include<cstdio>
#include<cstring>
#include<vector>
#include<cmath>
#include<queue>
#include<list>
#include<algorithm>
using namespace std;

const double eps=1e-8;
const double pi=2*asin(1.0);
struct point
{
    double x,y;
    double alpha;
    double len2;
    int id;
} p[200];
int T,n;
vector<point>v;
vector<int>ans;

double MinY;
int MinId;

bool cmp(const point &a, const point &b)
{
    if(fabs(a.alpha-b.alpha)<eps) return a.len2<b.len2;
    return a.alpha<b.alpha;
}

double len2(point a,point b)
{
    return (a.x-b.x)*(a.x-b.x)+(a.y-b.y)*(a.y-b.y);
}

double f(point a,point b,point c) //返回点a所对应的角的弧度
{
    double B2=(double)len2(a,c);
    double C2=(double)len2(a,b);
    double A2=(double)len2(b,c);
    double COSA=(B2+C2-A2)/(2*sqrt(B2)*sqrt(C2));
    return pi-acos(COSA);
}

double GetPointDistance(point p1, point p2)
{
    return sqrt((p1.x-p2.x)*(p1.x-p2.x)+(p1.y-p2.y)*(p1.y-p2.y));
}

double GetNearestDistance(point PA, point PB, point P3)
{
    double a,b,c;
    a=GetPointDistance(PB,P3);
    if(a<=0.00001) return 0.0f;
    b=GetPointDistance(PA,P3);
    if(b<=0.00001) return 0.0f;
    c=GetPointDistance(PA,PB);
    if(c<=0.00001) return a;
    if(a*a>=b*b+c*c) return b;
    if(b*b>=a*a+c*c) return a;
    double l=(a+b+c)/2;
    double s=sqrt(l*(l-a)*(l-b)*(l-c));
    return 2*s/c;
}

bool check(point T)
{
    double sum=0;
    for(int i=0;i<ans.size();i++)
        sum=sum+pi-(f(T,p[ans[i]],p[ans[(i+1)%ans.size()]]));
    if(fabs(sum-2*pi)<eps) return 0;
    return 1;
}

int main()
{
    double pegRadius ,pegX ,pegY ;
    while(~scanf("%d", &n))
    {
        if(n<3) break;
        scanf("%lf%lf%lf",&pegRadius,&pegX,&pegY);
        MinY=9999999999999;
        for(int i=1; i<=n; i++)
        {
            scanf("%lf%lf", &p[i].x, &p[i].y);
            p[i].id=i;
            if(p[i].y<MinY)
            {
                MinY=p[i].y;
                MinId=i;
            }
        }

        ans.clear();

        point pre; pre.x=-9999999999999; pre.y=p[MinId].y;
        point now; now.x=p[MinId].x; now.y=p[MinId].y; now.id=MinId;

        for(int i=1; i<=n; i++)
        {
            v.clear();
            for(int k=1; k<=n; k++)
            {
                if(p[k].id!=now.id)
                {
                    p[k].alpha=f(now,p[k],pre);
                    p[k].len2=len2(p[k],now);
                    v.push_back(p[k]);
                }
            }
            sort(v.begin(),v.end(),cmp);
            ans.push_back(v[0].id);
            if(v[0].id==MinId) break;

            pre.x=now.x;
            pre.y=now.y;
            pre.id=now.id;
            now.x=v[0].x;
            now.y=v[0].y;
            now.id=v[0].id;
        }

        if(ans.size()<n) printf("HOLE IS ILL-FORMED\n");

        else
        {
            bool fail=0;
            point T;
            T.x=pegX;
            T.y=pegY;

            if(check(T)) {fail=1;}
            else
            {
                for(int i=0; i<ans.size(); i++)
                {
                    double len=GetNearestDistance(p[ans[i]],p[ans[(i+1)%ans.size()]],T);
                    if(len+eps<=pegRadius) fail=1;
                }
            }

            if(fail==0) printf("PEG WILL FIT\n");
            else printf("PEG WILL NOT FIT\n");
        }
    }
    return 0;
}