HDU4998 Rotate (2014 ACM/ICPC Asia Regional Anshan Online)

题目链接：http://acm.hdu.edu.cn/showproblem.php?pid=4998

题意：给定n个点 和n个角度 ，平面内一个点分别以这个点Point(i)为旋转中心 逆时针旋转 R(i)度

求最后相当于绕那个点旋转多少度 求这个点的坐标 以及旋转的角度

一点（x，y）绕一个点（x0,y0）旋转 r0 度的公式为

x1= (x - x0)*cos(r0) - (y - y0)*sin(r0)  + x0 ;
y1= (x - x0)*sin(r0) + (y - y0)*cos(r0) + y0 ;

最后旋转点肯定是最后这两条由（xs1，ys1） (xs2,xs2) 组成的直线 以及 由（xe1，ye1） (xe2,xe2) 垂直平分线的交点，ansr = (r1+r2+.....+rn)%(2*pi);

代码如下：

#include <iostream>
#include <cstdio>
#include <cmath>
using namespace std;

const double pi = acos(-1.0);

struct point{
double x,y;
};

point calu(point a,point b,double r)
{
point c;
c.x = (a.x - b.x) * cos(r) - (a.y - b.y) * sin(r) + b.x;
c.y = (a.x - b.x) * sin(r) + (a.y - b.y) * cos(r) + b.y;
return c;
}

int main()
{
int n,t;
scanf("%d",&t);
while(t--){
point a,b,c,d;
double r,ansr;
scanf("%d",&n);
a.x=a.y=0;
b.x=b.y=1;
ansr=0;
for(int i=0;i<n;i++){
scanf("%lf%lf%lf",&c.x,&c.y,&r);
ansr+=r;
if(ansr>=2*pi)
ansr-=2*pi;
a=calu(a,c,r);
b=calu(b,c,r);
}
double t1 = (a.x*a.x+a.y*a.y)*(2*b.y-2)-2*a.y*(b.x*b.x+b.y*b.y)+4*a.y;
double t2 = 4*a.y-4*a.y*b.x+4*a.x*b.y-4*a.x;
double x = t1/t2;
double t3 = (a.x*a.x+a.y*a.y)-2*x*a.x;
double t4 = 2*a.y;
double y = t3/t4;
printf("%lf %lf %lf\n",x,y,ansr);
}
return 0;
}