//-------------------------------------------------------------------
bool testRotationTwoAxes( const BodyOrSpaceType bodyOrSpace, const Real angle1, const CoordinateAxis& axis1, const Real angle2, const CoordinateAxis &axis2 ) {
// Form rotation about specified axes
Rotation rotationSpecified( bodyOrSpace, angle1, axis1, angle2, axis2 );
// Form equivalent rotation by another means
Rotation AB( angle1, axis1 );
Rotation BC( angle2, axis2 );
Rotation testRotation = (bodyOrSpace == BodyRotationSequence) ? AB * BC : BC * AB;
// Test to see if they are the same
bool test = rotationSpecified.areAllRotationElementsSameToMachinePrecision( testRotation );
// Do the inverse problem to back out the angles
const Vec2 testVec = rotationSpecified.convertTwoAxesRotationToTwoAngles( bodyOrSpace, axis1, axis2 );
const Real theta1 = testVec[0];
const Real theta2 = testVec[1];
// Create a Rotation matrix with the backed-out angles and compare to the original Rotation matrix
testRotation.setRotationFromTwoAnglesTwoAxes( bodyOrSpace, theta1, axis1, theta2, axis2 );
test = test && rotationSpecified.areAllRotationElementsSameToMachinePrecision( testRotation );
// Conversion should produce same angles for for appropriate ranges of angle1 and angle2
if( axis1.isSameAxis(axis2) )
test = test && testInverseRotation1Angle( angle1+angle2, theta1+theta2 );
else
test = test && testInverseRotation2Angle( angle1,theta1, angle2,theta2 );
return test;
}
