プログラミングメモ →目次

座標の回転(アルゴリズム)

Coordinate Rotation

1.二次元座標回転

二次元座標回転は、数学式のとおりです。

void Rotate2(double x1, double y1, double alpha, double& x2, double& y2)
{
	x2 = x1 * cos(alpha) - y1 * sin(alpha);
	y2 = x1 * sin(alpha) + y1 * cos(alpha);
}

2.三次元座標回転

三次元座標回転は、数学式のとおりで実装しても良いですが、二次元座標回転のアルゴリズムを三回呼び出せば、分かりやすく処理速度も速いです。

void Rotate3(double x1, double y1, double z1, 
             double alphaX,double alphaY,double alphaZ, 
             double& x2, double& y2, double& z2)
{
	//Z Axis Rotation
	double x3 = x1 * cos(alphaZ) - y1 * sin(alphaZ);
	double y3 = x1 * sin(alphaZ) + y1 * cos(alphaZ);
	double z3 = z1;

	//Y Axis Rotation
	double z4 = z3 * cos(alphaY) - x3 * sin(alphaY);
	double x4 = z3 * sin(alphaY) + x3 * cos(alphaY);
	double y4 = y3;

	//X Axis Rotation
	y2 = y4 * cos(alphaX) - z4 * sin(alphaX);
	z2 = y4 * sin(alphaX) + z4 * cos(alphaX);
	x2 = x4;
}