HDU 4998 Rotate --几何

#include <iostream>
#include <cstdio>
#include <cstring>
#include <cstdlib>
#include <cmath>
#include <algorithm>
#define pii acos(-1.0)
#define eps 1e-8
using namespace std;
#define N 17

typedef struct point
{
   double x,y,radi;
   int ind;
   point(double x=0,double y=0):x(x),y(y){}
}Vector;

struct Point
{
    double x,y;
    Point(double x = 0,double y = 0):x(x),y(y){ }
};

Vector pi[N];
Point np[N];
int n;

int dcmp(double x)
{
    if(fabs(x)<eps)
        return 0;
    return x < 0 ? -1:1;
}
Vector operator  + (Vector A,Vector B){return Vector(A.x+B.x,A.y+B.y);}
Vector operator  -  (point A,point B){return Vector(A.x-B.x,A.y-B.y);}
Vector operator  *  (Vector A,double p){return Vector(A.x*p,A.y*p);}
Vector operator  /  (Vector A,double p){return Vector(A.x/p,A.y/p);}
bool operator ==  (const point& a,const point& b){return dcmp(a.x-b.x)==0&&dcmp(a.y-b.y)==0;}
bool operator < (const point& a,const point& b){return a.x<b.x ||(a.x==b.x&&a.y<b.y);} //比较和排序可用
double Cross(Vector A,Vector B){return A.x*B.y-A.y*B.x;}   //叉积 ，大于零说明B在A的左边,小于零说明B在A的右边
double Dot(Vector A,Vector B){return A.x*B.x+A.y*B.y;}    //点积
double Length(Vector A){return sqrt(Dot(A,A));}              //向量长度
double Angle(Vector A,Vector B){return acos(Dot(A,B)/Length(A)/Length(B));};
Vector Rotate(Vector A,double rad){return Vector(A.x*cos(rad)-A.y*sin(rad),A.x*sin(rad)+A.y*cos(rad));}//rad为弧度，向量逆时针旋转rad

int main()
{
    int t,i,j;
    scanf("%d",&t);
    while(t--)
    {
        scanf("%d",&n);
        for(i=1;i<=n;i++)
        {
            scanf("%lf%lf%lf",&pi[i].x,&pi[i].y,&pi[i].radi),pi[i].ind = i;
            np[i].x = pi[i].x;
            np[i].y = pi[i].y;
        }
        if(n == 1)
        {
            printf("%.10f %.10f %.10f\n",pi[1].x,pi[1].y,pi[1].radi);
            continue;
        }
        for(i=1;i<=n;i++)
        {
            for(j=1;j<=n;j++)
            {
                Vector k = Vector(np[j].x-pi[i].x,np[j].y-pi[i].y);
                k = Rotate(k,pi[i].radi);
                np[j].x = pi[i].x + k.x;
                np[j].y = pi[i].y + k.y;
            }
        }
        Point A,B,C,D;
        A = Point(pi[1].x,pi[1].y);
        B = np[1];
        C = Point(pi[2].x,pi[2].y);
        D = np[2];
        Point Mid1 = Point((A.x+B.x)/2.0,(A.y+B.y)/2.0);
        Point Mid2 = Point((C.x+D.x)/2.0,(C.y+D.y)/2.0);
        double k1,k2;
        double Ix,Iy;
        if(dcmp(A.y-B.y) == 0)
        {
            if(dcmp(D.x-C.x) == 0)
                k2 = 0.0;
            else
            {
                k2 = (D.y-C.y)/(D.x-C.x);
                k2 = -1.0/k2;
            }
            Ix = Mid1.x;
            Iy = Mid2.y + k2*(Mid1.x-Mid2.x);
        }
        else if(dcmp(D.y-C.y) == 0)
        {
            if(dcmp(B.x-A.x) == 0)
                k1 = 0.0;
            else
            {
                k1 = (B.y-A.y)/(B.x-A.x);
                k1 = -1.0/k1;
            }
            Ix = Mid2.x;
            Iy = Mid1.y + k1*(Mid2.x-Mid1.x);
        }
        else
        {
            k1 = (B.y-A.y)/(B.x-A.x);
            k1 = -1.0/k1;
            k2 = (D.y-C.y)/(D.x-C.x);
            k2 = -1.0/k2;
            double b1 = -k1*Mid1.x + Mid1.y;
            double b2 = -k2*Mid2.x + Mid2.y;
            Ix = (b2-b1)/(k1-k2);
            Iy = k1*Ix + b1;
        }
        Vector ka = Vector(pi[1].x-Ix,pi[1].y-Iy);
        Vector kb = Vector(np[1].x-Ix,np[1].y-Iy);
        double ang = Angle(ka,kb);
        double coss = Cross(ka,kb);
        if(dcmp(coss-0.0) == -1)
            ang = 2.0*pii-ang;
        printf("%.10f %.10f %.10f\n",Ix,Iy,ang);
    }
    return 0;
}