平面中,一个点(x,y)绕任意点(dx,dy)顺时针旋转a度后的坐标
xx= (x - dx)*cos(-a) - (y - dy)*sin(-a) + dx ;
yy= (x - dx)*sin(-a) + (y - dy)*cos(-a) +dy ;
平面中,一个点(x,y)绕任意点(dx,dy)逆时针旋转a度后的坐标
xx= (x - dx)*cos(a) - (y - dy)*sin(a) + dx ;
yy= (x - dx)*sin(a) + (y - dy)*cos(a) +dy ;
实现:
void aabb::rotate(double angle, Point3d center)
{
angle = -angle * PI / 180.0;
double a = center.x,b= center.y;
double x0 , y0;
for (int i = 0; i < point.size(); i++)
{
x0 = point[i].x;
y0 = point[i].y;
point[i].x= a + (x0 - a) * cos(angle) - (y0 - b) * sin(angle);
point[i].y= b + (x0 - a) * sin(angle) + (y0 - b) * cos(angle);
point[i].z -= min_z;
}
}