计算几何

点（x0，y0）绕（x1，y1）旋转弧度p后的坐标（ｘ２，ｙ２）

const double PI = acos(-1.0);
x2 = x1 + ( x0 - x1 ) * cos(p) - ( y0 - y1 ) * sin( p );
y2 = y1 + ( x0 - x1 ) * sin(p) + ( y0 - y1 ) * cos( p );