我有一个 3x3 旋转矩阵:
[ cos( angle ) sin( angle ) 0 ]
[ -sin( angle ) cos( angle ) 0 ]
[ 0 0 1 ]
我该如何锻炼angle
?
我现在使用的方法是:
void Mat3::SetAngle( const float angle ) {
m[ 0 + 0 * 3 ] = cos( angle );
m[ 1 + 0 * 3 ] = sin( angle );
m[ 0 + 1 * 3 ] = -sin( angle );
m[ 1 + 1 * 3 ] = cos( angle );
}
并检索它我正在使用:
float Mat3::GetAngle( void ) {
return atan2( m[ 1 + 0 * 3], m[ 0 + 0 * 3] );
}
我正在像这样测试它:
Mat3 m;
m.SetAngle( 179.0f );
float a = m.GetAngle();
a 最终是 3.0708115,这是不正确的。