学步园

也是醉了，不懂为什么最后的角度就是所有角度之和，但是题目这么说了，我也就这么做了好了。。。

#include <iostream>
#include <stdlib.h>
#include <stdio.h>
#include <math.h>
#include <algorithm>

using namespace std;

const int maxn = 15;
const double pi = acos(-1.0);

typedef struct Point
{
	double x, y, p;
	
	Point(double _x = 0, double _y = 0, double _p = 0):
		x(_x), y(_y), p(_p) {}
	
	Point operator +(Point argu)
	{
		return Point(x + argu.x, y + argu.y);
	}
	
	Point operator -(Point argu)
	{
		return Point(x - argu.x, y - argu.y);
	}
	
	double operator ^(Point argu)
	{
		return x * argu.y - y * argu.x;
	}
	
	Point operator *(double k)
	{
		return Point(x * k, y * k);
	}
	
	Point operator /(double k)
	{
		return Point(x / k, y / k);
	}
	
	Point rotate(Point argu)
	{
		Point r = argu - (*this);
		return Point(x + r.x * cos(p) - r.y * sin(p), y + r.x * sin(p) + r.y * cos(p));
	}
	
	void push(double nx, double ny)
	{
		x = nx;
		y = ny;
	}
	
	void in(void)
	{
		scanf("%lf%lf%lf", &x, &y, &p);
	}
	void out(void)
	{
		printf("%.10lf %.10lf ", x, y);
	}
}Vector;

Point pp[maxn];
Point reala, realb, stana, stanb;
Point mida, midb;
Vector va, vb;
double xa = 10010, ya = 10010, xb = 10010, yb = 10020;

Point get_center(Point p, Vector v, Point q, Vector w)
{
	Vector u = p - q;
	double t = (w ^ u) / (v ^ w);
	return (p + (v * t));
}

int main()
{
	//freopen("1002.in", "r", stdin);
	
	stana.push(xa, ya);
	stanb.push(xb, yb);
	int t;
	scanf("%d", &t);
	while(t--)
	{
		int n;
		double ang = 0.0;
		scanf("%d", &n);
		reala.push(xa, ya);
		realb.push(xb, yb);
		for(int i = 0; i < n; i++)
		{	
			pp[i].in();
			ang += pp[i].p;
		}
		ang = fmod(ang, 2.0 * pi);
		for(int i = 0; i < n; i++)
		{
			reala = pp[i].rotate(reala);
			realb = pp[i].rotate(realb);
		}
		mida = (stana + reala) / 2;
		midb = (stanb + realb) / 2;

		Vector va = Point(reala.y - stana.y, stana.x - reala.x);
		Vector vb = Point(realb.y - stanb.y, stanb.x - realb.x);
		Point c = get_center(mida, va, midb, vb);
		
		if(ang)
		{
			c.out();
			printf("%.10lf\n", ang);
		}
		else
			printf("%.10lf %.10lf %.10lf\n", 0.0, 0.0, 0.0);
	}
	return 0;
}