static void RemoveTwist(MT_Matrix3x3& R) { // compute twist parameter MT_Scalar tau = ComputeTwist(R); // compute twist matrix MT_Matrix3x3 T = ComputeTwistMatrix(tau); // remove twist R = R*T.transposed(); }