// // SPDX-License-Identifier: BSD-3-Clause // Copyright Contributors to the OpenEXR Project. // #ifdef NDEBUG # undef NDEBUG #endif #include #include #include #include #include #include #include #include "testQuat.h" // Include ImathForward *after* other headers to validate forward declarations #include using namespace std; using namespace IMATH_INTERNAL_NAMESPACE; namespace { template void testQuatT () { const T s = std::numeric_limits::min(); const T e = 4 * std::numeric_limits::epsilon(); // // constructors, r(), v() // { Quat q = Quat(); assert (q.r == 1 && q.v == Vec3 (0, 0, 0)); q = Quat (2, 3, 4, 5); assert (q.r == 2 && q.v == Vec3 (3, 4, 5)); q = Quat (6, Vec3 (7, 8, 9)); assert (q.r == 6 && q.v == Vec3 (7, 8, 9)); Quat q1 = Quat (q); assert (q1.r == 6 && q1.v == Vec3 (7, 8, 9)); } // // invert(), inverse() // { Quat q = Quat (1, 0, 0, 1); assert (q.inverse() == Quat (0.5, 0, 0, -0.5)); q.invert(); assert (q == Quat (0.5, 0, 0, -0.5)); } // // normalize(), normalized() // { Quat q = Quat (2, Vec3 (0, 0, 0)); assert (q.normalized() == Quat (1, 0, 0, 0)); q.normalize(); assert (q == Quat (1, 0, 0, 0)); q = Quat (0, Vec3 (0, 2, 0)); assert (q.normalized() == Quat (0, 0, 1, 0)); q.normalize(); assert (q == Quat (0, 0, 1, 0)); } // // length() // { Quat q = Quat (3, 0, 4, 0); assert (q.length() == 5); } // // setAxisAngle(), angle(), axis() // { Quat q; q.setAxisAngle (Vec3 (0, 0, 1), T(M_PI_2)); Vec3 v = q.axis (); T a = q.angle (); assert (v.equalWithAbsError (Vec3 (0, 0, 1), e)); assert (IMATH_INTERNAL_NAMESPACE::equal (a, T (M_PI_2), e)); } // // Accuracy of angle() for very small angles // and when real part is slightly greater than 1. // { T t = 10 * std::sqrt (s); Quat q; q.setAxisAngle (Vec3 (0, 0, 1), t); Vec3 v = q.axis (); T a = q.angle (); assert (v.equalWithAbsError (Vec3 (0, 0, 1), e)); assert (IMATH_INTERNAL_NAMESPACE::equal (a, t, t * e)); q.r *= T(1.1); q.v *= T(1.1); v = q.axis (); a = q.angle (); assert (v.equalWithAbsError (Vec3 (0, 0, 1), e)); assert (IMATH_INTERNAL_NAMESPACE::equal (a, t, t * e)); } { T t = T(0.001) * std::sqrt (s); Quat q; q.setAxisAngle (Vec3 (0, 0, 1), t); Vec3 v = q.axis (); T a = q.angle (); assert (v.equalWithAbsError (Vec3 (0, 0, 1), e)); assert (IMATH_INTERNAL_NAMESPACE::equal (a, t, t * e)); q.r *= T(1.1); q.v *= T(1.1); v = q.axis (); a = q.angle (); assert (v.equalWithAbsError (Vec3 (0, 0, 1), e)); assert (IMATH_INTERNAL_NAMESPACE::equal (a, t, t * e)); } // // toMatrix33(), toMatrix44() // { Quat q; q.setRotation (Vec3 (1, 0, 0), Vec3 (0, 1, 0)); Matrix33 m1 = q.toMatrix33(); // clang-format off assert (m1.equalWithAbsError (Matrix33 (0, 1, 0, -1, 0, 0, 0, 0, 1), e)); Matrix44 m2 = q.toMatrix44(); assert (m2.equalWithAbsError (Matrix44 (0, 1, 0, 0, -1, 0, 0, 0, 0, 0, 1, 0, 0, 0, 0, 1), e)); // clang-format on } // // +, - (unary and binary), ~ *, /, ^ // assert (Quat (1, 2, 3, 4) + Quat (5, 6, 7, 8) == Quat (6, 8, 10, 12)); assert (Quat (-1, -2, -3, -4) - Quat (5, 6, 7, 8) == Quat (-6, -8, -10, -12)); assert (-Quat (1, 2, 3, 4) == Quat (-1, -2, -3, -4)); assert (~Quat (1, 2, 3, 4) == Quat (1, -2, -3, -4)); assert (T (2) * Quat (1, 2, 3, 4) == Quat (2, 4, 6, 8)); assert (Quat (1, 2, 3, 4) * T (2 )== Quat (2, 4, 6, 8)); assert (Quat (1, 0, 0, 1) * Quat (1, 1, 0, 0) == Quat (1, 1, 1, 1)); assert (Quat (1, 1, 0, 0) * Quat (1, 0, 0, 1) == Quat (1, 1, -1, 1)); assert (Quat (1, 0, 0, 1) / Quat (0.5, -0.5, 0, 0) == Quat (1, 1, 1, 1)); assert (Quat (2, 4, 6, 8) / T (2) == Quat (1, 2, 3, 4)); assert ((Quat (1, 2, 3, 4) ^ Quat (2, 2, 2, 2)) == 20); // // extract() // { Vec3 vFrom (1, 0, 0); Vec3 vTo (0, 1, 1); Matrix44 m1 = rotationMatrix (vFrom, vTo); Quat q = extractQuat (m1); ; Matrix44 m2 = q.toMatrix44(); assert (m2.equalWithAbsError (m1, 2 * e)); } } void testQuatConversions () { { Quatf q (1, V3f (2, 3, 4)); Quatd q1 = Quatd (q); assert (q1.r == 1 && q1.v == V3d (2, 3, 4)); } { Quatd q (1, V3d (2, 3, 4)); Quatf q1 = Quatf (q); assert (q1.r == 1 && q1.v == V3f (2, 3, 4)); } } } // namespace void testQuat () { cout << "Testing basic quaternion operations" << endl; testQuatT(); testQuatT(); testQuatConversions(); cout << "ok\n" << endl; }