void expectSameMatrices(const Lumix::Matrix& mtx1, const Lumix::Matrix& mtx2) { for (int i = 0; i < 16; ++i) { LUMIX_EXPECT_CLOSE_EQ(*((&mtx1.m11) + i), *((&mtx2.m11) + i), 0.001f); } }
void UT_math_utils_ease_in_out(const char* params) { LUMIX_EXPECT_CLOSE_EQ(Lumix::Math::easeInOut(0), 0, 0.001f); LUMIX_EXPECT_CLOSE_EQ(Lumix::Math::easeInOut(0.1f), 0.02f, 0.001f); LUMIX_EXPECT_CLOSE_EQ(Lumix::Math::easeInOut(0.25f), 0.125f, 0.001f); LUMIX_EXPECT_CLOSE_EQ(Lumix::Math::easeInOut(0.5f), 0.5f, 0.001f); LUMIX_EXPECT_CLOSE_EQ(Lumix::Math::easeInOut(0.75f), 0.875f, 0.001f); LUMIX_EXPECT_CLOSE_EQ(Lumix::Math::easeInOut(1), 1, 0.001f); for(float f = 0; f <= 0.5f; f += 0.01f) { LUMIX_EXPECT_CLOSE_EQ(Lumix::Math::easeInOut(f), 1 - Lumix::Math::easeInOut(1 - f), 0.001f); } for(float f = 0; f <= 0.42f; f += 0.01f) { LUMIX_EXPECT(Lumix::Math::easeInOut(f) < Lumix::Math::easeInOut(f + 0.01f)); LUMIX_EXPECT(Lumix::Math::easeInOut(f + 0.01f) - Lumix::Math::easeInOut(f) < Lumix::Math::easeInOut(f + 0.02f) - Lumix::Math::easeInOut(f + 0.01f)); } }
void UT_vec3(const char* params) { Lumix::DefaultAllocator allocator; Lumix::Vec3 v(0, 0, 0); LUMIX_EXPECT(v.x == 0); LUMIX_EXPECT(v.y == 0); LUMIX_EXPECT(v.z == 0); LUMIX_EXPECT_CLOSE_EQ(v.length(), 0, 0.001f); LUMIX_EXPECT_CLOSE_EQ(v.squaredLength(), 0, 0.001f); Lumix::Vec3 v2(1, 0, 0); LUMIX_EXPECT(v2.x == 1); LUMIX_EXPECT(v2.y == 0); LUMIX_EXPECT(v2.z == 0); LUMIX_EXPECT_CLOSE_EQ(v2.length(), 1, 0.001f); LUMIX_EXPECT_CLOSE_EQ(v2.squaredLength(), 1, 0.001f); v2.normalize(); LUMIX_EXPECT_CLOSE_EQ(v2.length(), 1, 0.001f); LUMIX_EXPECT_CLOSE_EQ(v2.squaredLength(), 1, 0.001f); v2.set(1, 2, 3); LUMIX_EXPECT(v2.x == 1); LUMIX_EXPECT(v2.y == 2); LUMIX_EXPECT(v2.z == 3); LUMIX_EXPECT_CLOSE_EQ(v2.length(), 3.74165750f, 0.001f); LUMIX_EXPECT_CLOSE_EQ(v2.squaredLength(), 3.74165750f * 3.74165750f, 0.001f); LUMIX_EXPECT_CLOSE_EQ(v2.normalized().length(), 1, 0.001f); LUMIX_EXPECT_CLOSE_EQ(v2.normalized().y, 2 * v2.normalized().x, 0.001f); LUMIX_EXPECT_CLOSE_EQ(v2.normalized().z, 3 * v2.normalized().x, 0.001f); v2.normalize(); LUMIX_EXPECT_CLOSE_EQ(v2.length(), 1, 0.001f); LUMIX_EXPECT_CLOSE_EQ(v2.y, 2 * v2.x, 0.001f); LUMIX_EXPECT_CLOSE_EQ(v2.z, 3 * v2.x, 0.001f); v = -Lumix::Vec3(1, 2, 3); LUMIX_EXPECT_CLOSE_EQ(v.x, -1, 0.001f); LUMIX_EXPECT_CLOSE_EQ(v.y, -2, 0.001f); LUMIX_EXPECT_CLOSE_EQ(v.z, -3, 0.001f); v = v + Lumix::Vec3(4, 5, 6); LUMIX_EXPECT_CLOSE_EQ(v.x, 3, 0.001f); LUMIX_EXPECT_CLOSE_EQ(v.y, 3, 0.001f); LUMIX_EXPECT_CLOSE_EQ(v.z, 3, 0.001f); v = v * 2; LUMIX_EXPECT_CLOSE_EQ(v.x, 6, 0.001f); LUMIX_EXPECT_CLOSE_EQ(v.y, 6, 0.001f); LUMIX_EXPECT_CLOSE_EQ(v.z, 6, 0.001f); LUMIX_EXPECT_CLOSE_EQ(Lumix::dotProduct(Lumix::Vec3(1, 0, 0), Lumix::Vec3(0, 1, 0)), 0, 0.001f); LUMIX_EXPECT_CLOSE_EQ(Lumix::dotProduct(Lumix::Vec3(1, 0, 0), Lumix::Vec3(1, 0, 0)), 1, 0.001f); v = Lumix::crossProduct(Lumix::Vec3(1, 0, 0), Lumix::Vec3(0, 1, 0)); LUMIX_EXPECT_CLOSE_EQ(v.x, 0, 0.001f); LUMIX_EXPECT_CLOSE_EQ(v.y, 0, 0.001f); LUMIX_EXPECT_CLOSE_EQ(v.z, 1, 0.001f); Lumix::lerp(Lumix::Vec3(1, 0, 0), Lumix::Vec3(0, 1, 0), &v, 0); LUMIX_EXPECT_CLOSE_EQ(v.x, 1, 0.001f); LUMIX_EXPECT_CLOSE_EQ(v.y, 0, 0.001f); LUMIX_EXPECT_CLOSE_EQ(v.z, 0, 0.001f); Lumix::lerp(Lumix::Vec3(1, 0, 0), Lumix::Vec3(0, 1, 0), &v, 1); LUMIX_EXPECT_CLOSE_EQ(v.x, 0, 0.001f); LUMIX_EXPECT_CLOSE_EQ(v.y, 1, 0.001f); LUMIX_EXPECT_CLOSE_EQ(v.z, 0, 0.001f); Lumix::lerp(Lumix::Vec3(1, 0, 0), Lumix::Vec3(0, 1, 0), &v, 0.5f); LUMIX_EXPECT_CLOSE_EQ(v.x, 0.5f, 0.001f); LUMIX_EXPECT_CLOSE_EQ(v.y, 0.5f, 0.001f); LUMIX_EXPECT_CLOSE_EQ(v.z, 0, 0.001f); }
void UT_quat(const char* params) { Lumix::Quat q1, q2; Lumix::Matrix mtx; q1.set(1.0f, 0.0f, 0.0f, 0.0f); LUMIX_EXPECT_CLOSE_EQ(q1.x, 1.0f, 0.001f); LUMIX_EXPECT_CLOSE_EQ(q1.y, 0.0f, 0.001f); LUMIX_EXPECT_CLOSE_EQ(q1.z, 0.0f, 0.001f); LUMIX_EXPECT_CLOSE_EQ(q1.w, 0.0f, 0.001f); q1.toMatrix(mtx); mtx.getRotation(q2); LUMIX_EXPECT_CLOSE_EQ(q1.x, q2.x, 0.001f); LUMIX_EXPECT_CLOSE_EQ(q1.y, q2.y, 0.001f); LUMIX_EXPECT_CLOSE_EQ(q1.z, q2.z, 0.001f); LUMIX_EXPECT_CLOSE_EQ(q1.w, q2.w, 0.001f); q1.set(0, 0, 1, 0); q1.toMatrix(mtx); mtx.getRotation(q2); LUMIX_EXPECT_CLOSE_EQ(q1.x, q2.x, 0.001f); LUMIX_EXPECT_CLOSE_EQ(q1.y, q2.y, 0.001f); LUMIX_EXPECT_CLOSE_EQ(q1.z, q2.z, 0.001f); LUMIX_EXPECT_CLOSE_EQ(q1.w, q2.w, 0.001f); q1 = Lumix::Quat(Lumix::Vec3(1, 0, 0), Lumix::Math::PI / 4); q1.toMatrix(mtx); mtx.getRotation(q2); LUMIX_EXPECT_CLOSE_EQ(q1.x, q2.x, 0.001f); LUMIX_EXPECT_CLOSE_EQ(q1.y, q2.y, 0.001f); LUMIX_EXPECT_CLOSE_EQ(q1.z, q2.z, 0.001f); LUMIX_EXPECT_CLOSE_EQ(q1.w, q2.w, 0.001f); q1 = Lumix::Quat(Lumix::Vec3(1, 1, 0), Lumix::Math::PI / 6); q1.normalize(); q1.toMatrix(mtx); mtx.getRotation(q2); LUMIX_EXPECT_CLOSE_EQ(q1.x, q2.x, 0.001f); LUMIX_EXPECT_CLOSE_EQ(q1.y, q2.y, 0.001f); LUMIX_EXPECT_CLOSE_EQ(q1.z, q2.z, 0.001f); LUMIX_EXPECT_CLOSE_EQ(q1.w, q2.w, 0.001f); q1.set(0.923879862f, 0, 0, -0.382683545f); q1.toMatrix(mtx); mtx.getRotation(q2); LUMIX_EXPECT_CLOSE_EQ(q1.x, q2.x, 0.001f); LUMIX_EXPECT_CLOSE_EQ(q1.y, q2.y, 0.001f); LUMIX_EXPECT_CLOSE_EQ(q1.z, q2.z, 0.001f); LUMIX_EXPECT_CLOSE_EQ(q1.w, q2.w, 0.001f); Lumix::Quat qeuler; for (float x = -Lumix::Math::PI + 0.01f; x < Lumix::Math::PI; x += 0.1f) { for (float y = -Lumix::Math::PI + 0.01f; y < Lumix::Math::PI; y += 0.1f) { float x = 0; for (float z = -Lumix::Math::PI + 0.01f; z < Lumix::Math::PI; z += 0.1f) { qeuler.fromEuler(Lumix::Vec3(x, y, z)); Lumix::Vec3 u(0, 1, 0); u = qeuler * u; Lumix::Vec3 euler = qeuler.toEuler(); LUMIX_EXPECT_CLOSE_EQ(euler.x, x, 0.001f); LUMIX_EXPECT_CLOSE_EQ(euler.y, y, 0.001f); LUMIX_EXPECT_CLOSE_EQ(euler.z, z, 0.001f); } } } }
void UT_matrix(const char* params) { Lumix::DefaultAllocator allocator; for (int i = 0; i < 16; ++i) { LUMIX_EXPECT_CLOSE_EQ(*((&Lumix::Matrix::IDENTITY.m11) + i), i % 5 == 0 ? 1.0f : 0.0f, 0.001f); } Lumix::Matrix mtx = Lumix::Matrix::IDENTITY; expectSameMatrices(mtx, Lumix::Matrix::IDENTITY); LUMIX_EXPECT_CLOSE_EQ(mtx.determinant(), 1.0f, 0.001f); mtx.inverse(); expectSameMatrices(mtx, Lumix::Matrix::IDENTITY); mtx.fastInverse(); expectSameMatrices(mtx, Lumix::Matrix::IDENTITY); mtx.transpose(); expectSameMatrices(mtx, Lumix::Matrix::IDENTITY); LUMIX_EXPECT_CLOSE_EQ(mtx.getTranslation().x, 0, 0.001f); LUMIX_EXPECT_CLOSE_EQ(mtx.getTranslation().y, 0, 0.001f); LUMIX_EXPECT_CLOSE_EQ(mtx.getTranslation().z, 0, 0.001f); Lumix::Quat rot; mtx.getRotation(rot); LUMIX_EXPECT_CLOSE_EQ(rot.x, 0, 0.001f); LUMIX_EXPECT_CLOSE_EQ(rot.y, 0, 0.001f); LUMIX_EXPECT_CLOSE_EQ(rot.z, 0, 0.001f); LUMIX_EXPECT_CLOSE_EQ(rot.w, 1, 0.001f); LUMIX_EXPECT_CLOSE_EQ(mtx.getXVector().x, 1, 0.001f); LUMIX_EXPECT_CLOSE_EQ(mtx.getXVector().y, 0, 0.001f); LUMIX_EXPECT_CLOSE_EQ(mtx.getXVector().z, 0, 0.001f); LUMIX_EXPECT_CLOSE_EQ(mtx.getYVector().x, 0, 0.001f); LUMIX_EXPECT_CLOSE_EQ(mtx.getYVector().y, 1, 0.001f); LUMIX_EXPECT_CLOSE_EQ(mtx.getYVector().z, 0, 0.001f); LUMIX_EXPECT_CLOSE_EQ(mtx.getZVector().x, 0, 0.001f); LUMIX_EXPECT_CLOSE_EQ(mtx.getZVector().y, 0, 0.001f); LUMIX_EXPECT_CLOSE_EQ(mtx.getZVector().z, 1, 0.001f); mtx.multiply3x3(1.0f); expectSameMatrices(mtx, Lumix::Matrix::IDENTITY); Lumix::Vec3 v = mtx.multiplyPosition(Lumix::Vec3(1, 2, 3)); LUMIX_EXPECT_CLOSE_EQ(v.x, 1, 0.001f); LUMIX_EXPECT_CLOSE_EQ(v.y, 2, 0.001f); LUMIX_EXPECT_CLOSE_EQ(v.z, 3, 0.001f); mtx.setTranslation(Lumix::Vec3(1, 2, 3)); LUMIX_EXPECT_CLOSE_EQ(mtx.m41, 1, 0.001f); LUMIX_EXPECT_CLOSE_EQ(mtx.m42, 2, 0.001f); LUMIX_EXPECT_CLOSE_EQ(mtx.m43, 3, 0.001f); mtx.setIdentity(); expectSameMatrices(mtx, Lumix::Matrix::IDENTITY); mtx.translate(Lumix::Vec3(1, 2, 3)); LUMIX_EXPECT_CLOSE_EQ(mtx.m41, 1, 0.001f); LUMIX_EXPECT_CLOSE_EQ(mtx.m42, 2, 0.001f); LUMIX_EXPECT_CLOSE_EQ(mtx.m43, 3, 0.001f); mtx.setIdentity(); mtx.setXVector(Lumix::Vec3(3, 2, 1)); LUMIX_EXPECT_CLOSE_EQ(mtx.m11, 3, 0.001f); LUMIX_EXPECT_CLOSE_EQ(mtx.m12, 2, 0.001f); LUMIX_EXPECT_CLOSE_EQ(mtx.m13, 1, 0.001f); mtx.setYVector(Lumix::Vec3(6, 5, 4)); LUMIX_EXPECT_CLOSE_EQ(mtx.m21, 6, 0.001f); LUMIX_EXPECT_CLOSE_EQ(mtx.m22, 5, 0.001f); LUMIX_EXPECT_CLOSE_EQ(mtx.m23, 4, 0.001f); mtx.setZVector(Lumix::Vec3(9, 8, 7)); LUMIX_EXPECT_CLOSE_EQ(mtx.m31, 9, 0.001f); LUMIX_EXPECT_CLOSE_EQ(mtx.m32, 8, 0.001f); LUMIX_EXPECT_CLOSE_EQ(mtx.m33, 7, 0.001f); Lumix::Matrix old = mtx; expectSameMatrices(mtx, old); mtx.transpose(); mtx.transpose(); expectSameMatrices(mtx, old); mtx.inverse(); mtx.inverse(); expectSameMatrices(mtx, old); mtx.setIdentity(); mtx.multiply3x3(2.0f); old = mtx; mtx.inverse(); mtx.inverse(); expectSameMatrices(mtx, old); for (int i = 0; i < 16; ++i) { *((&mtx.m11) + i) = (float)i; } old = mtx; mtx = mtx * Lumix::Matrix::IDENTITY; expectSameMatrices(mtx, old); mtx = Lumix::Matrix::IDENTITY * mtx; expectSameMatrices(mtx, old); Lumix::Matrix euler; euler.fromEuler(0, 0, 0); expectSameMatrices(euler, Lumix::Matrix::IDENTITY); Lumix::Matrix check_matrix; check_matrix = Lumix::Matrix::IDENTITY; check_matrix.m11 = -1; check_matrix.m33 = -1; euler.fromEuler(3.14159265f, 0, 0); expectSameMatrices(euler, check_matrix); check_matrix = Lumix::Matrix::IDENTITY; check_matrix.m11 = -1; check_matrix.m22 = -1; euler.fromEuler(0, 0, 3.14159265f); expectSameMatrices(euler, check_matrix); check_matrix = Lumix::Matrix::IDENTITY; check_matrix.m22 = -1; check_matrix.m33 = -1; euler.fromEuler(0, 3.14159265f, 0); expectSameMatrices(euler, check_matrix); }
void UT_math_utils_degrees_to_radians(const char* params) { LUMIX_EXPECT_CLOSE_EQ(Lumix::Math::degreesToRadians(0), 0, 0.001f); LUMIX_EXPECT_CLOSE_EQ(Lumix::Math::degreesToRadians(22.5f), Lumix::Math::PI * 0.125f, 0.001f); LUMIX_EXPECT_CLOSE_EQ(Lumix::Math::degreesToRadians(-22.5f), -Lumix::Math::PI * 0.125f, 0.001f); LUMIX_EXPECT_CLOSE_EQ(Lumix::Math::degreesToRadians(45), Lumix::Math::PI * 0.25f, 0.001f); LUMIX_EXPECT_CLOSE_EQ(Lumix::Math::degreesToRadians(-45), -Lumix::Math::PI * 0.25f, 0.001f); LUMIX_EXPECT_CLOSE_EQ(Lumix::Math::degreesToRadians(90), Lumix::Math::PI * 0.5f, 0.001f); LUMIX_EXPECT_CLOSE_EQ(Lumix::Math::degreesToRadians(-90), -Lumix::Math::PI * 0.5f, 0.001f); LUMIX_EXPECT_CLOSE_EQ(Lumix::Math::degreesToRadians(180), Lumix::Math::PI, 0.001f); LUMIX_EXPECT_CLOSE_EQ(Lumix::Math::degreesToRadians(-180), -Lumix::Math::PI, 0.001f); LUMIX_EXPECT_CLOSE_EQ(Lumix::Math::degreesToRadians(360), Lumix::Math::PI * 2, 0.001f); LUMIX_EXPECT_CLOSE_EQ(Lumix::Math::degreesToRadians(-360), -Lumix::Math::PI * 2, 0.001f); LUMIX_EXPECT_CLOSE_EQ(Lumix::Math::degreesToRadians(720), Lumix::Math::PI * 4, 0.001f); LUMIX_EXPECT_CLOSE_EQ(Lumix::Math::degreesToRadians(-720), -Lumix::Math::PI * 4, 0.001f); }