static void quaternion_slerp (mutest_spec_t *spec) { graphene_quaternion_t q1, q2, q3; graphene_quaternion_init (&q1, 0.0f, 0.0f, 0.0f, 1.0f); graphene_quaternion_init (&q2, 0.2f, 0.3f, 0.4f, 0.5f); mutest_expect ("initial and final states are different", mutest_bool_value (graphene_quaternion_equal (&q1, &q2)), mutest_to_be_false, NULL); graphene_quaternion_slerp (&q1, &q2, 0.33f, &q3); mutest_expect ("interpolated result is different from the initial state", mutest_bool_value (graphene_quaternion_equal (&q1, &q3)), mutest_to_be_false, NULL); graphene_quaternion_slerp (&q1, &q2, 0.66f, &q3); mutest_expect ("interpolated result is different from the final state", mutest_bool_value (graphene_quaternion_equal (&q2, &q3)), mutest_to_be_false, NULL); }
/** * graphene_matrix_interpolate: * @a: ... * @b: ... * @factor: ... * @res: (out caller-allocates): ... * * ... * * Since: 1.0 */ void graphene_matrix_interpolate (const graphene_matrix_t *a, const graphene_matrix_t *b, double factor, graphene_matrix_t *res) { graphene_point3d_t scale_a = { 1.f, 1.f, 1.f }, translate_a; graphene_vec4_t perspective_a; graphene_quaternion_t rotate_a; float shear_a[3] = { 0.f, 0.f, 0.f }; graphene_point3d_t scale_b = { 1.f, 1.f, 1.f }, translate_b; graphene_vec4_t perspective_b; graphene_quaternion_t rotate_b; float shear_b[3] = { 0.f, 0.f, 0.f }; graphene_point3d_t scale_r = { 1.f, 1.f, 1.f }, translate_r; graphene_quaternion_t rotate_r; graphene_matrix_t tmp; float shear; g_return_if_fail (a != NULL && b != NULL); g_return_if_fail (res != NULL); if (graphene_matrix_is_2d (a) && graphene_matrix_is_2d (b)) { graphene_vec4_init (&perspective_a, 0.f, 0.f, 0.f, 1.f); graphene_vec4_init (&perspective_b, 0.f, 0.f, 0.f, 1.f); matrix_decompose_2d (a, &scale_a, shear_a, &rotate_a, &translate_a); matrix_decompose_2d (b, &scale_b, shear_b, &rotate_b, &translate_b); } else { matrix_decompose_3d (a, &scale_a, shear_a, &rotate_a, &translate_a, &perspective_a); matrix_decompose_3d (b, &scale_b, shear_b, &rotate_b, &translate_b, &perspective_b); } res->value.w = graphene_simd4f_interpolate (perspective_a.value, perspective_b.value, factor); graphene_point3d_interpolate (&translate_a, &translate_b, factor, &translate_r); graphene_matrix_translate (res, &translate_r); graphene_quaternion_slerp (&rotate_a, &rotate_b, factor, &rotate_r); graphene_quaternion_to_matrix (&rotate_r, &tmp); if (!graphene_matrix_is_identity (&tmp)) graphene_matrix_multiply (&tmp, res, res); shear = shear_a[YZ_SHEAR] + (shear_b[YZ_SHEAR] - shear_a[YZ_SHEAR]) * factor; if (shear != 0.f) graphene_matrix_skew_yz (res, shear); shear = shear_a[XZ_SHEAR] + (shear_b[XZ_SHEAR] - shear_a[XZ_SHEAR]) * factor; if (shear != 0.f) graphene_matrix_skew_xz (res, shear); shear = shear_a[XY_SHEAR] + (shear_b[XY_SHEAR] - shear_a[XY_SHEAR]) * factor; if (shear != 0.f) graphene_matrix_skew_xy (res, shear); graphene_point3d_interpolate (&scale_a, &scale_b, factor, &scale_r); if (scale_r.x != 1.f && scale_r.y != 1.f && scale_r.z != 0.f) graphene_matrix_scale (res, scale_r.x, scale_r.y, scale_r.z); }