139 lines
5.6 KiB
Text
139 lines
5.6 KiB
Text
{% macro impl_mat4_inverse() %}
|
|
// Based on https://github.com/g-truc/glm `glm_mat4_inverse`
|
|
let fac0 = {
|
|
let swp0a = i32x4_shuffle::<3, 3, 7, 7>(self.w_axis.0, self.z_axis.0);
|
|
let swp0b = i32x4_shuffle::<2, 2, 6, 6>(self.w_axis.0, self.z_axis.0);
|
|
|
|
let swp00 = i32x4_shuffle::<2, 2, 6, 6>(self.z_axis.0, self.y_axis.0);
|
|
let swp01 = i32x4_shuffle::<0, 0, 4, 6>(swp0a, swp0a);
|
|
let swp02 = i32x4_shuffle::<0, 0, 4, 6>(swp0b, swp0b);
|
|
let swp03 = i32x4_shuffle::<3, 3, 7, 7>(self.z_axis.0, self.y_axis.0);
|
|
|
|
let mul00 = f32x4_mul(swp00, swp01);
|
|
let mul01 = f32x4_mul(swp02, swp03);
|
|
f32x4_sub(mul00, mul01)
|
|
};
|
|
let fac1 = {
|
|
let swp0a = i32x4_shuffle::<3, 3, 7, 7>(self.w_axis.0, self.z_axis.0);
|
|
let swp0b = i32x4_shuffle::<1, 1, 5, 5>(self.w_axis.0, self.z_axis.0);
|
|
|
|
let swp00 = i32x4_shuffle::<1, 1, 5, 5>(self.z_axis.0, self.y_axis.0);
|
|
let swp01 = i32x4_shuffle::<0, 0, 4, 6>(swp0a, swp0a);
|
|
let swp02 = i32x4_shuffle::<0, 0, 4, 6>(swp0b, swp0b);
|
|
let swp03 = i32x4_shuffle::<3, 3, 7, 7>(self.z_axis.0, self.y_axis.0);
|
|
|
|
let mul00 = f32x4_mul(swp00, swp01);
|
|
let mul01 = f32x4_mul(swp02, swp03);
|
|
f32x4_sub(mul00, mul01)
|
|
};
|
|
let fac2 = {
|
|
let swp0a = i32x4_shuffle::<2, 2, 6, 6>(self.w_axis.0, self.z_axis.0);
|
|
let swp0b = i32x4_shuffle::<1, 1, 5, 5>(self.w_axis.0, self.z_axis.0);
|
|
|
|
let swp00 = i32x4_shuffle::<1, 1, 5, 5>(self.z_axis.0, self.y_axis.0);
|
|
let swp01 = i32x4_shuffle::<0, 0, 4, 6>(swp0a, swp0a);
|
|
let swp02 = i32x4_shuffle::<0, 0, 4, 6>(swp0b, swp0b);
|
|
let swp03 = i32x4_shuffle::<2, 2, 6, 6>(self.z_axis.0, self.y_axis.0);
|
|
|
|
let mul00 = f32x4_mul(swp00, swp01);
|
|
let mul01 = f32x4_mul(swp02, swp03);
|
|
f32x4_sub(mul00, mul01)
|
|
};
|
|
let fac3 = {
|
|
let swp0a = i32x4_shuffle::<3, 3, 7, 7>(self.w_axis.0, self.z_axis.0);
|
|
let swp0b = i32x4_shuffle::<0, 0, 4, 4>(self.w_axis.0, self.z_axis.0);
|
|
|
|
let swp00 = i32x4_shuffle::<0, 0, 4, 4>(self.z_axis.0, self.y_axis.0);
|
|
let swp01 = i32x4_shuffle::<0, 0, 4, 6>(swp0a, swp0a);
|
|
let swp02 = i32x4_shuffle::<0, 0, 4, 6>(swp0b, swp0b);
|
|
let swp03 = i32x4_shuffle::<3, 3, 7, 7>(self.z_axis.0, self.y_axis.0);
|
|
|
|
let mul00 = f32x4_mul(swp00, swp01);
|
|
let mul01 = f32x4_mul(swp02, swp03);
|
|
f32x4_sub(mul00, mul01)
|
|
};
|
|
let fac4 = {
|
|
let swp0a = i32x4_shuffle::<2, 2, 6, 6>(self.w_axis.0, self.z_axis.0);
|
|
let swp0b = i32x4_shuffle::<0, 0, 4, 4>(self.w_axis.0, self.z_axis.0);
|
|
|
|
let swp00 = i32x4_shuffle::<0, 0, 4, 4>(self.z_axis.0, self.y_axis.0);
|
|
let swp01 = i32x4_shuffle::<0, 0, 4, 6>(swp0a, swp0a);
|
|
let swp02 = i32x4_shuffle::<0, 0, 4, 6>(swp0b, swp0b);
|
|
let swp03 = i32x4_shuffle::<2, 2, 6, 6>(self.z_axis.0, self.y_axis.0);
|
|
|
|
let mul00 = f32x4_mul(swp00, swp01);
|
|
let mul01 = f32x4_mul(swp02, swp03);
|
|
f32x4_sub(mul00, mul01)
|
|
};
|
|
let fac5 = {
|
|
let swp0a = i32x4_shuffle::<1, 1, 5, 5>(self.w_axis.0, self.z_axis.0);
|
|
let swp0b = i32x4_shuffle::<0, 0, 4, 4>(self.w_axis.0, self.z_axis.0);
|
|
|
|
let swp00 = i32x4_shuffle::<0, 0, 4, 4>(self.z_axis.0, self.y_axis.0);
|
|
let swp01 = i32x4_shuffle::<0, 0, 4, 6>(swp0a, swp0a);
|
|
let swp02 = i32x4_shuffle::<0, 0, 4, 6>(swp0b, swp0b);
|
|
let swp03 = i32x4_shuffle::<1, 1, 5, 5>(self.z_axis.0, self.y_axis.0);
|
|
|
|
let mul00 = f32x4_mul(swp00, swp01);
|
|
let mul01 = f32x4_mul(swp02, swp03);
|
|
f32x4_sub(mul00, mul01)
|
|
};
|
|
let sign_a = f32x4(-1.0, 1.0, -1.0, 1.0);
|
|
let sign_b = f32x4(1.0, -1.0, 1.0, -1.0);
|
|
|
|
let temp0 = i32x4_shuffle::<0, 0, 4, 4>(self.y_axis.0, self.x_axis.0);
|
|
let vec0 = i32x4_shuffle::<0, 2, 6, 6>(temp0, temp0);
|
|
|
|
let temp1 = i32x4_shuffle::<1, 1, 5, 5>(self.y_axis.0, self.x_axis.0);
|
|
let vec1 = i32x4_shuffle::<0, 2, 6, 6>(temp1, temp1);
|
|
|
|
let temp2 = i32x4_shuffle::<2, 2, 6, 6>(self.y_axis.0, self.x_axis.0);
|
|
let vec2 = i32x4_shuffle::<0, 2, 6, 6>(temp2, temp2);
|
|
|
|
let temp3 = i32x4_shuffle::<3, 3, 7, 7>(self.y_axis.0, self.x_axis.0);
|
|
let vec3 = i32x4_shuffle::<0, 2, 6, 6>(temp3, temp3);
|
|
|
|
let mul00 = f32x4_mul(vec1, fac0);
|
|
let mul01 = f32x4_mul(vec2, fac1);
|
|
let mul02 = f32x4_mul(vec3, fac2);
|
|
let sub00 = f32x4_sub(mul00, mul01);
|
|
let add00 = f32x4_add(sub00, mul02);
|
|
let inv0 = f32x4_mul(sign_b, add00);
|
|
|
|
let mul03 = f32x4_mul(vec0, fac0);
|
|
let mul04 = f32x4_mul(vec2, fac3);
|
|
let mul05 = f32x4_mul(vec3, fac4);
|
|
let sub01 = f32x4_sub(mul03, mul04);
|
|
let add01 = f32x4_add(sub01, mul05);
|
|
let inv1 = f32x4_mul(sign_a, add01);
|
|
|
|
let mul06 = f32x4_mul(vec0, fac1);
|
|
let mul07 = f32x4_mul(vec1, fac3);
|
|
let mul08 = f32x4_mul(vec3, fac5);
|
|
let sub02 = f32x4_sub(mul06, mul07);
|
|
let add02 = f32x4_add(sub02, mul08);
|
|
let inv2 = f32x4_mul(sign_b, add02);
|
|
|
|
let mul09 = f32x4_mul(vec0, fac2);
|
|
let mul10 = f32x4_mul(vec1, fac4);
|
|
let mul11 = f32x4_mul(vec2, fac5);
|
|
let sub03 = f32x4_sub(mul09, mul10);
|
|
let add03 = f32x4_add(sub03, mul11);
|
|
let inv3 = f32x4_mul(sign_a, add03);
|
|
|
|
let row0 = i32x4_shuffle::<0, 0, 4, 4>(inv0, inv1);
|
|
let row1 = i32x4_shuffle::<0, 0, 4, 4>(inv2, inv3);
|
|
let row2 = i32x4_shuffle::<0, 2, 4, 6>(row0, row1);
|
|
|
|
let dot0 = dot4(self.x_axis.0, row2);
|
|
glam_assert!(dot0 != 0.0);
|
|
|
|
let rcp0 = f32x4_splat(dot0.recip());
|
|
|
|
Self {
|
|
x_axis: Vec4(f32x4_mul(inv0, rcp0)),
|
|
y_axis: Vec4(f32x4_mul(inv1, rcp0)),
|
|
z_axis: Vec4(f32x4_mul(inv2, rcp0)),
|
|
w_axis: Vec4(f32x4_mul(inv3, rcp0)),
|
|
}
|
|
{% endmacro impl_mat4_inverse %}
|