public void ExtractYawPitchRollTest(float yaw, float pitch, float roll)
{
float radiansYaw = (float)(yaw * System.Math.PI / 180);
float radiansPitch = (float)(pitch * System.Math.PI / 180);
float radiansRoll = (float)(roll * System.Math.PI / 180);
Matrix3x3 matrix = Matrix3x3.CreateFromYawPitchRoll(radiansYaw, radiansPitch, radiansRoll);
float extractedYaw;
float extractedPitch;
float extractedRoll;
matrix.ExtractYawPitchRoll(out extractedYaw, out extractedPitch, out extractedRoll);
Assert.AreEqual(radiansYaw, extractedYaw, Epsilon);
Assert.AreEqual(radiansPitch, extractedPitch, Epsilon);
Assert.AreEqual(radiansRoll, extractedRoll, Epsilon);
}