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);
}
