|
@@ -584,7 +584,7 @@ angle_axis_from_quaternion :: proc {
|
|
|
|
|
|
|
|
|
|
@(require_results)
|
|
@(require_results)
|
|
-quaternion_from_forward_and_up_f16 :: proc "contextless" (forward, up: Vector3f16) -> Quaternionf16 #no_bounds_check {
|
|
|
|
|
|
+quaternion_from_forward_and_up_f16 :: proc "contextless" (forward, up: Vector3f16) -> Quaternionf16 {
|
|
f := normalize(forward)
|
|
f := normalize(forward)
|
|
s := normalize(cross(f, up))
|
|
s := normalize(cross(f, up))
|
|
u := cross(s, f)
|
|
u := cross(s, f)
|
|
@@ -628,7 +628,7 @@ quaternion_from_forward_and_up_f16 :: proc "contextless" (forward, up: Vector3f1
|
|
return normalize(q)
|
|
return normalize(q)
|
|
}
|
|
}
|
|
@(require_results)
|
|
@(require_results)
|
|
-quaternion_from_forward_and_up_f32 :: proc "contextless" (forward, up: Vector3f32) -> Quaternionf32 #no_bounds_check {
|
|
|
|
|
|
+quaternion_from_forward_and_up_f32 :: proc "contextless" (forward, up: Vector3f32) -> Quaternionf32 {
|
|
f := normalize(forward)
|
|
f := normalize(forward)
|
|
s := normalize(cross(f, up))
|
|
s := normalize(cross(f, up))
|
|
u := cross(s, f)
|
|
u := cross(s, f)
|
|
@@ -672,7 +672,7 @@ quaternion_from_forward_and_up_f32 :: proc "contextless" (forward, up: Vector3f3
|
|
return normalize(q)
|
|
return normalize(q)
|
|
}
|
|
}
|
|
@(require_results)
|
|
@(require_results)
|
|
-quaternion_from_forward_and_up_f64 :: proc "contextless" (forward, up: Vector3f64) -> Quaternionf64 #no_bounds_check {
|
|
|
|
|
|
+quaternion_from_forward_and_up_f64 :: proc "contextless" (forward, up: Vector3f64) -> Quaternionf64 {
|
|
f := normalize(forward)
|
|
f := normalize(forward)
|
|
s := normalize(cross(f, up))
|
|
s := normalize(cross(f, up))
|
|
u := cross(s, f)
|
|
u := cross(s, f)
|
|
@@ -886,7 +886,7 @@ quaternion_squad :: proc{
|
|
|
|
|
|
|
|
|
|
@(require_results)
|
|
@(require_results)
|
|
-quaternion_from_matrix4_f16 :: proc "contextless" (m: Matrix4f16) -> (q: Quaternionf16) #no_bounds_check {
|
|
|
|
|
|
+quaternion_from_matrix4_f16 :: proc "contextless" (m: Matrix4f16) -> (q: Quaternionf16) {
|
|
m3: Matrix3f16 = ---
|
|
m3: Matrix3f16 = ---
|
|
m3[0, 0], m3[1, 0], m3[2, 0] = m[0, 0], m[1, 0], m[2, 0]
|
|
m3[0, 0], m3[1, 0], m3[2, 0] = m[0, 0], m[1, 0], m[2, 0]
|
|
m3[0, 1], m3[1, 1], m3[2, 1] = m[0, 1], m[1, 1], m[2, 1]
|
|
m3[0, 1], m3[1, 1], m3[2, 1] = m[0, 1], m[1, 1], m[2, 1]
|
|
@@ -894,7 +894,7 @@ quaternion_from_matrix4_f16 :: proc "contextless" (m: Matrix4f16) -> (q: Quatern
|
|
return quaternion_from_matrix3(m3)
|
|
return quaternion_from_matrix3(m3)
|
|
}
|
|
}
|
|
@(require_results)
|
|
@(require_results)
|
|
-quaternion_from_matrix4_f32 :: proc "contextless" (m: Matrix4f32) -> (q: Quaternionf32) #no_bounds_check {
|
|
|
|
|
|
+quaternion_from_matrix4_f32 :: proc "contextless" (m: Matrix4f32) -> (q: Quaternionf32) {
|
|
m3: Matrix3f32 = ---
|
|
m3: Matrix3f32 = ---
|
|
m3[0, 0], m3[1, 0], m3[2, 0] = m[0, 0], m[1, 0], m[2, 0]
|
|
m3[0, 0], m3[1, 0], m3[2, 0] = m[0, 0], m[1, 0], m[2, 0]
|
|
m3[0, 1], m3[1, 1], m3[2, 1] = m[0, 1], m[1, 1], m[2, 1]
|
|
m3[0, 1], m3[1, 1], m3[2, 1] = m[0, 1], m[1, 1], m[2, 1]
|
|
@@ -902,7 +902,7 @@ quaternion_from_matrix4_f32 :: proc "contextless" (m: Matrix4f32) -> (q: Quatern
|
|
return quaternion_from_matrix3(m3)
|
|
return quaternion_from_matrix3(m3)
|
|
}
|
|
}
|
|
@(require_results)
|
|
@(require_results)
|
|
-quaternion_from_matrix4_f64 :: proc "contextless" (m: Matrix4f64) -> (q: Quaternionf64) #no_bounds_check {
|
|
|
|
|
|
+quaternion_from_matrix4_f64 :: proc "contextless" (m: Matrix4f64) -> (q: Quaternionf64) {
|
|
m3: Matrix3f64 = ---
|
|
m3: Matrix3f64 = ---
|
|
m3[0, 0], m3[1, 0], m3[2, 0] = m[0, 0], m[1, 0], m[2, 0]
|
|
m3[0, 0], m3[1, 0], m3[2, 0] = m[0, 0], m[1, 0], m[2, 0]
|
|
m3[0, 1], m3[1, 1], m3[2, 1] = m[0, 1], m[1, 1], m[2, 1]
|
|
m3[0, 1], m3[1, 1], m3[2, 1] = m[0, 1], m[1, 1], m[2, 1]
|
|
@@ -917,7 +917,7 @@ quaternion_from_matrix4 :: proc{
|
|
|
|
|
|
|
|
|
|
@(require_results)
|
|
@(require_results)
|
|
-quaternion_from_matrix3_f16 :: proc "contextless" (m: Matrix3f16) -> (q: Quaternionf16) #no_bounds_check {
|
|
|
|
|
|
+quaternion_from_matrix3_f16 :: proc "contextless" (m: Matrix3f16) -> (q: Quaternionf16) {
|
|
four_x_squared_minus_1 := m[0, 0] - m[1, 1] - m[2, 2]
|
|
four_x_squared_minus_1 := m[0, 0] - m[1, 1] - m[2, 2]
|
|
four_y_squared_minus_1 := m[1, 1] - m[0, 0] - m[2, 2]
|
|
four_y_squared_minus_1 := m[1, 1] - m[0, 0] - m[2, 2]
|
|
four_z_squared_minus_1 := m[2, 2] - m[0, 0] - m[1, 1]
|
|
four_z_squared_minus_1 := m[2, 2] - m[0, 0] - m[1, 1]
|
|
@@ -967,7 +967,7 @@ quaternion_from_matrix3_f16 :: proc "contextless" (m: Matrix3f16) -> (q: Quatern
|
|
return
|
|
return
|
|
}
|
|
}
|
|
@(require_results)
|
|
@(require_results)
|
|
-quaternion_from_matrix3_f32 :: proc "contextless" (m: Matrix3f32) -> (q: Quaternionf32) #no_bounds_check {
|
|
|
|
|
|
+quaternion_from_matrix3_f32 :: proc "contextless" (m: Matrix3f32) -> (q: Quaternionf32) {
|
|
four_x_squared_minus_1 := m[0, 0] - m[1, 1] - m[2, 2]
|
|
four_x_squared_minus_1 := m[0, 0] - m[1, 1] - m[2, 2]
|
|
four_y_squared_minus_1 := m[1, 1] - m[0, 0] - m[2, 2]
|
|
four_y_squared_minus_1 := m[1, 1] - m[0, 0] - m[2, 2]
|
|
four_z_squared_minus_1 := m[2, 2] - m[0, 0] - m[1, 1]
|
|
four_z_squared_minus_1 := m[2, 2] - m[0, 0] - m[1, 1]
|
|
@@ -1017,7 +1017,7 @@ quaternion_from_matrix3_f32 :: proc "contextless" (m: Matrix3f32) -> (q: Quatern
|
|
return
|
|
return
|
|
}
|
|
}
|
|
@(require_results)
|
|
@(require_results)
|
|
-quaternion_from_matrix3_f64 :: proc "contextless" (m: Matrix3f64) -> (q: Quaternionf64) #no_bounds_check {
|
|
|
|
|
|
+quaternion_from_matrix3_f64 :: proc "contextless" (m: Matrix3f64) -> (q: Quaternionf64) {
|
|
four_x_squared_minus_1 := m[0, 0] - m[1, 1] - m[2, 2]
|
|
four_x_squared_minus_1 := m[0, 0] - m[1, 1] - m[2, 2]
|
|
four_y_squared_minus_1 := m[1, 1] - m[0, 0] - m[2, 2]
|
|
four_y_squared_minus_1 := m[1, 1] - m[0, 0] - m[2, 2]
|
|
four_z_squared_minus_1 := m[2, 2] - m[0, 0] - m[1, 1]
|
|
four_z_squared_minus_1 := m[2, 2] - m[0, 0] - m[1, 1]
|
|
@@ -1147,7 +1147,7 @@ quaternion_between_two_vector3 :: proc{
|
|
|
|
|
|
|
|
|
|
@(require_results)
|
|
@(require_results)
|
|
-matrix2_inverse_transpose_f16 :: proc "contextless" (m: Matrix2f16) -> (c: Matrix2f16) #no_bounds_check {
|
|
|
|
|
|
+matrix2_inverse_transpose_f16 :: proc "contextless" (m: Matrix2f16) -> (c: Matrix2f16) {
|
|
d := m[0, 0]*m[1, 1] - m[0, 1]*m[1, 0]
|
|
d := m[0, 0]*m[1, 1] - m[0, 1]*m[1, 0]
|
|
id := 1.0/d
|
|
id := 1.0/d
|
|
c[0, 0] = +m[1, 1] * id
|
|
c[0, 0] = +m[1, 1] * id
|
|
@@ -1157,7 +1157,7 @@ matrix2_inverse_transpose_f16 :: proc "contextless" (m: Matrix2f16) -> (c: Matri
|
|
return c
|
|
return c
|
|
}
|
|
}
|
|
@(require_results)
|
|
@(require_results)
|
|
-matrix2_inverse_transpose_f32 :: proc "contextless" (m: Matrix2f32) -> (c: Matrix2f32) #no_bounds_check {
|
|
|
|
|
|
+matrix2_inverse_transpose_f32 :: proc "contextless" (m: Matrix2f32) -> (c: Matrix2f32) {
|
|
d := m[0, 0]*m[1, 1] - m[0, 1]*m[1, 0]
|
|
d := m[0, 0]*m[1, 1] - m[0, 1]*m[1, 0]
|
|
id := 1.0/d
|
|
id := 1.0/d
|
|
c[0, 0] = +m[1, 1] * id
|
|
c[0, 0] = +m[1, 1] * id
|
|
@@ -1167,7 +1167,7 @@ matrix2_inverse_transpose_f32 :: proc "contextless" (m: Matrix2f32) -> (c: Matri
|
|
return c
|
|
return c
|
|
}
|
|
}
|
|
@(require_results)
|
|
@(require_results)
|
|
-matrix2_inverse_transpose_f64 :: proc "contextless" (m: Matrix2f64) -> (c: Matrix2f64) #no_bounds_check {
|
|
|
|
|
|
+matrix2_inverse_transpose_f64 :: proc "contextless" (m: Matrix2f64) -> (c: Matrix2f64) {
|
|
d := m[0, 0]*m[1, 1] - m[0, 1]*m[1, 0]
|
|
d := m[0, 0]*m[1, 1] - m[0, 1]*m[1, 0]
|
|
id := 1.0/d
|
|
id := 1.0/d
|
|
c[0, 0] = +m[1, 1] * id
|
|
c[0, 0] = +m[1, 1] * id
|
|
@@ -1184,15 +1184,15 @@ matrix2_inverse_transpose :: proc{
|
|
|
|
|
|
|
|
|
|
@(require_results)
|
|
@(require_results)
|
|
-matrix2_determinant_f16 :: proc "contextless" (m: Matrix2f16) -> f16 #no_bounds_check {
|
|
|
|
|
|
+matrix2_determinant_f16 :: proc "contextless" (m: Matrix2f16) -> f16 {
|
|
return m[0, 0]*m[1, 1] - m[0, 1]*m[1, 0]
|
|
return m[0, 0]*m[1, 1] - m[0, 1]*m[1, 0]
|
|
}
|
|
}
|
|
@(require_results)
|
|
@(require_results)
|
|
-matrix2_determinant_f32 :: proc "contextless" (m: Matrix2f32) -> f32 #no_bounds_check {
|
|
|
|
|
|
+matrix2_determinant_f32 :: proc "contextless" (m: Matrix2f32) -> f32 {
|
|
return m[0, 0]*m[1, 1] - m[0, 1]*m[1, 0]
|
|
return m[0, 0]*m[1, 1] - m[0, 1]*m[1, 0]
|
|
}
|
|
}
|
|
@(require_results)
|
|
@(require_results)
|
|
-matrix2_determinant_f64 :: proc "contextless" (m: Matrix2f64) -> f64 #no_bounds_check {
|
|
|
|
|
|
+matrix2_determinant_f64 :: proc "contextless" (m: Matrix2f64) -> f64 {
|
|
return m[0, 0]*m[1, 1] - m[0, 1]*m[1, 0]
|
|
return m[0, 0]*m[1, 1] - m[0, 1]*m[1, 0]
|
|
}
|
|
}
|
|
matrix2_determinant :: proc{
|
|
matrix2_determinant :: proc{
|
|
@@ -1203,7 +1203,7 @@ matrix2_determinant :: proc{
|
|
|
|
|
|
|
|
|
|
@(require_results)
|
|
@(require_results)
|
|
-matrix2_inverse_f16 :: proc "contextless" (m: Matrix2f16) -> (c: Matrix2f16) #no_bounds_check {
|
|
|
|
|
|
+matrix2_inverse_f16 :: proc "contextless" (m: Matrix2f16) -> (c: Matrix2f16) {
|
|
d := m[0, 0]*m[1, 1] - m[0, 1]*m[1, 0]
|
|
d := m[0, 0]*m[1, 1] - m[0, 1]*m[1, 0]
|
|
id := 1.0/d
|
|
id := 1.0/d
|
|
c[0, 0] = +m[1, 1] * id
|
|
c[0, 0] = +m[1, 1] * id
|
|
@@ -1213,7 +1213,7 @@ matrix2_inverse_f16 :: proc "contextless" (m: Matrix2f16) -> (c: Matrix2f16) #no
|
|
return c
|
|
return c
|
|
}
|
|
}
|
|
@(require_results)
|
|
@(require_results)
|
|
-matrix2_inverse_f32 :: proc "contextless" (m: Matrix2f32) -> (c: Matrix2f32) #no_bounds_check {
|
|
|
|
|
|
+matrix2_inverse_f32 :: proc "contextless" (m: Matrix2f32) -> (c: Matrix2f32) {
|
|
d := m[0, 0]*m[1, 1] - m[0, 1]*m[1, 0]
|
|
d := m[0, 0]*m[1, 1] - m[0, 1]*m[1, 0]
|
|
id := 1.0/d
|
|
id := 1.0/d
|
|
c[0, 0] = +m[1, 1] * id
|
|
c[0, 0] = +m[1, 1] * id
|
|
@@ -1223,7 +1223,7 @@ matrix2_inverse_f32 :: proc "contextless" (m: Matrix2f32) -> (c: Matrix2f32) #no
|
|
return c
|
|
return c
|
|
}
|
|
}
|
|
@(require_results)
|
|
@(require_results)
|
|
-matrix2_inverse_f64 :: proc "contextless" (m: Matrix2f64) -> (c: Matrix2f64) #no_bounds_check {
|
|
|
|
|
|
+matrix2_inverse_f64 :: proc "contextless" (m: Matrix2f64) -> (c: Matrix2f64) {
|
|
d := m[0, 0]*m[1, 1] - m[0, 1]*m[1, 0]
|
|
d := m[0, 0]*m[1, 1] - m[0, 1]*m[1, 0]
|
|
id := 1.0/d
|
|
id := 1.0/d
|
|
c[0, 0] = +m[1, 1] * id
|
|
c[0, 0] = +m[1, 1] * id
|
|
@@ -1240,7 +1240,7 @@ matrix2_inverse :: proc{
|
|
|
|
|
|
|
|
|
|
@(require_results)
|
|
@(require_results)
|
|
-matrix2_adjoint_f16 :: proc "contextless" (m: Matrix2f16) -> (c: Matrix2f16) #no_bounds_check {
|
|
|
|
|
|
+matrix2_adjoint_f16 :: proc "contextless" (m: Matrix2f16) -> (c: Matrix2f16) {
|
|
c[0, 0] = +m[1, 1]
|
|
c[0, 0] = +m[1, 1]
|
|
c[1, 0] = -m[0, 1]
|
|
c[1, 0] = -m[0, 1]
|
|
c[0, 1] = -m[1, 0]
|
|
c[0, 1] = -m[1, 0]
|
|
@@ -1248,7 +1248,7 @@ matrix2_adjoint_f16 :: proc "contextless" (m: Matrix2f16) -> (c: Matrix2f16) #no
|
|
return c
|
|
return c
|
|
}
|
|
}
|
|
@(require_results)
|
|
@(require_results)
|
|
-matrix2_adjoint_f32 :: proc "contextless" (m: Matrix2f32) -> (c: Matrix2f32) #no_bounds_check {
|
|
|
|
|
|
+matrix2_adjoint_f32 :: proc "contextless" (m: Matrix2f32) -> (c: Matrix2f32) {
|
|
c[0, 0] = +m[1, 1]
|
|
c[0, 0] = +m[1, 1]
|
|
c[1, 0] = -m[0, 1]
|
|
c[1, 0] = -m[0, 1]
|
|
c[0, 1] = -m[1, 0]
|
|
c[0, 1] = -m[1, 0]
|
|
@@ -1256,7 +1256,7 @@ matrix2_adjoint_f32 :: proc "contextless" (m: Matrix2f32) -> (c: Matrix2f32) #no
|
|
return c
|
|
return c
|
|
}
|
|
}
|
|
@(require_results)
|
|
@(require_results)
|
|
-matrix2_adjoint_f64 :: proc "contextless" (m: Matrix2f64) -> (c: Matrix2f64) #no_bounds_check {
|
|
|
|
|
|
+matrix2_adjoint_f64 :: proc "contextless" (m: Matrix2f64) -> (c: Matrix2f64) {
|
|
c[0, 0] = +m[1, 1]
|
|
c[0, 0] = +m[1, 1]
|
|
c[1, 0] = -m[0, 1]
|
|
c[1, 0] = -m[0, 1]
|
|
c[0, 1] = -m[1, 0]
|
|
c[0, 1] = -m[1, 0]
|
|
@@ -1308,7 +1308,7 @@ matrix2_rotate :: proc{
|
|
|
|
|
|
|
|
|
|
@(require_results)
|
|
@(require_results)
|
|
-matrix3_from_quaternion_f16 :: proc "contextless" (q: Quaternionf16) -> (m: Matrix3f16) #no_bounds_check {
|
|
|
|
|
|
+matrix3_from_quaternion_f16 :: proc "contextless" (q: Quaternionf16) -> (m: Matrix3f16) {
|
|
qxx := q.x * q.x
|
|
qxx := q.x * q.x
|
|
qyy := q.y * q.y
|
|
qyy := q.y * q.y
|
|
qzz := q.z * q.z
|
|
qzz := q.z * q.z
|
|
@@ -1333,7 +1333,7 @@ matrix3_from_quaternion_f16 :: proc "contextless" (q: Quaternionf16) -> (m: Matr
|
|
return m
|
|
return m
|
|
}
|
|
}
|
|
@(require_results)
|
|
@(require_results)
|
|
-matrix3_from_quaternion_f32 :: proc "contextless" (q: Quaternionf32) -> (m: Matrix3f32) #no_bounds_check {
|
|
|
|
|
|
+matrix3_from_quaternion_f32 :: proc "contextless" (q: Quaternionf32) -> (m: Matrix3f32) {
|
|
qxx := q.x * q.x
|
|
qxx := q.x * q.x
|
|
qyy := q.y * q.y
|
|
qyy := q.y * q.y
|
|
qzz := q.z * q.z
|
|
qzz := q.z * q.z
|
|
@@ -1358,7 +1358,7 @@ matrix3_from_quaternion_f32 :: proc "contextless" (q: Quaternionf32) -> (m: Matr
|
|
return m
|
|
return m
|
|
}
|
|
}
|
|
@(require_results)
|
|
@(require_results)
|
|
-matrix3_from_quaternion_f64 :: proc "contextless" (q: Quaternionf64) -> (m: Matrix3f64) #no_bounds_check {
|
|
|
|
|
|
+matrix3_from_quaternion_f64 :: proc "contextless" (q: Quaternionf64) -> (m: Matrix3f64) {
|
|
qxx := q.x * q.x
|
|
qxx := q.x * q.x
|
|
qyy := q.y * q.y
|
|
qyy := q.y * q.y
|
|
qzz := q.z * q.z
|
|
qzz := q.z * q.z
|
|
@@ -1409,21 +1409,21 @@ matrix3_inverse :: proc{
|
|
|
|
|
|
|
|
|
|
@(require_results)
|
|
@(require_results)
|
|
-matrix3_determinant_f16 :: proc "contextless" (m: Matrix3f16) -> f16 #no_bounds_check {
|
|
|
|
|
|
+matrix3_determinant_f16 :: proc "contextless" (m: Matrix3f16) -> f16 {
|
|
a := +m[0, 0] * (m[1, 1] * m[2, 2] - m[1, 2] * m[2, 1])
|
|
a := +m[0, 0] * (m[1, 1] * m[2, 2] - m[1, 2] * m[2, 1])
|
|
b := -m[0, 1] * (m[1, 0] * m[2, 2] - m[1, 2] * m[2, 0])
|
|
b := -m[0, 1] * (m[1, 0] * m[2, 2] - m[1, 2] * m[2, 0])
|
|
c := +m[0, 2] * (m[1, 0] * m[2, 1] - m[1, 1] * m[2, 0])
|
|
c := +m[0, 2] * (m[1, 0] * m[2, 1] - m[1, 1] * m[2, 0])
|
|
return a + b + c
|
|
return a + b + c
|
|
}
|
|
}
|
|
@(require_results)
|
|
@(require_results)
|
|
-matrix3_determinant_f32 :: proc "contextless" (m: Matrix3f32) -> f32 #no_bounds_check {
|
|
|
|
|
|
+matrix3_determinant_f32 :: proc "contextless" (m: Matrix3f32) -> f32 {
|
|
a := +m[0, 0] * (m[1, 1] * m[2, 2] - m[1, 2] * m[2, 1])
|
|
a := +m[0, 0] * (m[1, 1] * m[2, 2] - m[1, 2] * m[2, 1])
|
|
b := -m[0, 1] * (m[1, 0] * m[2, 2] - m[1, 2] * m[2, 0])
|
|
b := -m[0, 1] * (m[1, 0] * m[2, 2] - m[1, 2] * m[2, 0])
|
|
c := +m[0, 2] * (m[1, 0] * m[2, 1] - m[1, 1] * m[2, 0])
|
|
c := +m[0, 2] * (m[1, 0] * m[2, 1] - m[1, 1] * m[2, 0])
|
|
return a + b + c
|
|
return a + b + c
|
|
}
|
|
}
|
|
@(require_results)
|
|
@(require_results)
|
|
-matrix3_determinant_f64 :: proc "contextless" (m: Matrix3f64) -> f64 #no_bounds_check {
|
|
|
|
|
|
+matrix3_determinant_f64 :: proc "contextless" (m: Matrix3f64) -> f64 {
|
|
a := +m[0, 0] * (m[1, 1] * m[2, 2] - m[1, 2] * m[2, 1])
|
|
a := +m[0, 0] * (m[1, 1] * m[2, 2] - m[1, 2] * m[2, 1])
|
|
b := -m[0, 1] * (m[1, 0] * m[2, 2] - m[1, 2] * m[2, 0])
|
|
b := -m[0, 1] * (m[1, 0] * m[2, 2] - m[1, 2] * m[2, 0])
|
|
c := +m[0, 2] * (m[1, 0] * m[2, 1] - m[1, 1] * m[2, 0])
|
|
c := +m[0, 2] * (m[1, 0] * m[2, 1] - m[1, 1] * m[2, 0])
|
|
@@ -1437,7 +1437,7 @@ matrix3_determinant :: proc{
|
|
|
|
|
|
|
|
|
|
@(require_results)
|
|
@(require_results)
|
|
-matrix3_adjoint_f16 :: proc "contextless" (m: Matrix3f16) -> (adjoint: Matrix3f16) #no_bounds_check {
|
|
|
|
|
|
+matrix3_adjoint_f16 :: proc "contextless" (m: Matrix3f16) -> (adjoint: Matrix3f16) {
|
|
adjoint[0, 0] = +(m[1, 1] * m[2, 2] - m[2, 1] * m[1, 2])
|
|
adjoint[0, 0] = +(m[1, 1] * m[2, 2] - m[2, 1] * m[1, 2])
|
|
adjoint[0, 1] = -(m[1, 0] * m[2, 2] - m[2, 0] * m[1, 2])
|
|
adjoint[0, 1] = -(m[1, 0] * m[2, 2] - m[2, 0] * m[1, 2])
|
|
adjoint[0, 2] = +(m[1, 0] * m[2, 1] - m[2, 0] * m[1, 1])
|
|
adjoint[0, 2] = +(m[1, 0] * m[2, 1] - m[2, 0] * m[1, 1])
|
|
@@ -1450,7 +1450,7 @@ matrix3_adjoint_f16 :: proc "contextless" (m: Matrix3f16) -> (adjoint: Matrix3f1
|
|
return adjoint
|
|
return adjoint
|
|
}
|
|
}
|
|
@(require_results)
|
|
@(require_results)
|
|
-matrix3_adjoint_f32 :: proc "contextless" (m: Matrix3f32) -> (adjoint: Matrix3f32) #no_bounds_check {
|
|
|
|
|
|
+matrix3_adjoint_f32 :: proc "contextless" (m: Matrix3f32) -> (adjoint: Matrix3f32) {
|
|
adjoint[0, 0] = +(m[1, 1] * m[2, 2] - m[2, 1] * m[1, 2])
|
|
adjoint[0, 0] = +(m[1, 1] * m[2, 2] - m[2, 1] * m[1, 2])
|
|
adjoint[0, 1] = -(m[1, 0] * m[2, 2] - m[2, 0] * m[1, 2])
|
|
adjoint[0, 1] = -(m[1, 0] * m[2, 2] - m[2, 0] * m[1, 2])
|
|
adjoint[0, 2] = +(m[1, 0] * m[2, 1] - m[2, 0] * m[1, 1])
|
|
adjoint[0, 2] = +(m[1, 0] * m[2, 1] - m[2, 0] * m[1, 1])
|
|
@@ -1463,7 +1463,7 @@ matrix3_adjoint_f32 :: proc "contextless" (m: Matrix3f32) -> (adjoint: Matrix3f3
|
|
return adjoint
|
|
return adjoint
|
|
}
|
|
}
|
|
@(require_results)
|
|
@(require_results)
|
|
-matrix3_adjoint_f64 :: proc "contextless" (m: Matrix3f64) -> (adjoint: Matrix3f64) #no_bounds_check {
|
|
|
|
|
|
+matrix3_adjoint_f64 :: proc "contextless" (m: Matrix3f64) -> (adjoint: Matrix3f64) {
|
|
adjoint[0, 0] = +(m[1, 1] * m[2, 2] - m[2, 1] * m[1, 2])
|
|
adjoint[0, 0] = +(m[1, 1] * m[2, 2] - m[2, 1] * m[1, 2])
|
|
adjoint[0, 1] = -(m[1, 0] * m[2, 2] - m[2, 0] * m[1, 2])
|
|
adjoint[0, 1] = -(m[1, 0] * m[2, 2] - m[2, 0] * m[1, 2])
|
|
adjoint[0, 2] = +(m[1, 0] * m[2, 1] - m[2, 0] * m[1, 1])
|
|
adjoint[0, 2] = +(m[1, 0] * m[2, 1] - m[2, 0] * m[1, 1])
|
|
@@ -1503,21 +1503,21 @@ matrix3_inverse_transpose :: proc{
|
|
|
|
|
|
|
|
|
|
@(require_results)
|
|
@(require_results)
|
|
-matrix3_scale_f16 :: proc "contextless" (s: Vector3f16) -> (m: Matrix3f16) #no_bounds_check {
|
|
|
|
|
|
+matrix3_scale_f16 :: proc "contextless" (s: Vector3f16) -> (m: Matrix3f16) {
|
|
m[0, 0] = s[0]
|
|
m[0, 0] = s[0]
|
|
m[1, 1] = s[1]
|
|
m[1, 1] = s[1]
|
|
m[2, 2] = s[2]
|
|
m[2, 2] = s[2]
|
|
return m
|
|
return m
|
|
}
|
|
}
|
|
@(require_results)
|
|
@(require_results)
|
|
-matrix3_scale_f32 :: proc "contextless" (s: Vector3f32) -> (m: Matrix3f32) #no_bounds_check {
|
|
|
|
|
|
+matrix3_scale_f32 :: proc "contextless" (s: Vector3f32) -> (m: Matrix3f32) {
|
|
m[0, 0] = s[0]
|
|
m[0, 0] = s[0]
|
|
m[1, 1] = s[1]
|
|
m[1, 1] = s[1]
|
|
m[2, 2] = s[2]
|
|
m[2, 2] = s[2]
|
|
return m
|
|
return m
|
|
}
|
|
}
|
|
@(require_results)
|
|
@(require_results)
|
|
-matrix3_scale_f64 :: proc "contextless" (s: Vector3f64) -> (m: Matrix3f64) #no_bounds_check {
|
|
|
|
|
|
+matrix3_scale_f64 :: proc "contextless" (s: Vector3f64) -> (m: Matrix3f64) {
|
|
m[0, 0] = s[0]
|
|
m[0, 0] = s[0]
|
|
m[1, 1] = s[1]
|
|
m[1, 1] = s[1]
|
|
m[2, 2] = s[2]
|
|
m[2, 2] = s[2]
|
|
@@ -1531,7 +1531,7 @@ matrix3_scale :: proc{
|
|
|
|
|
|
|
|
|
|
@(require_results)
|
|
@(require_results)
|
|
-matrix3_rotate_f16 :: proc "contextless" (angle_radians: f16, v: Vector3f16) -> (rot: Matrix3f16) #no_bounds_check {
|
|
|
|
|
|
+matrix3_rotate_f16 :: proc "contextless" (angle_radians: f16, v: Vector3f16) -> (rot: Matrix3f16) {
|
|
c := math.cos(angle_radians)
|
|
c := math.cos(angle_radians)
|
|
s := math.sin(angle_radians)
|
|
s := math.sin(angle_radians)
|
|
|
|
|
|
@@ -1553,7 +1553,7 @@ matrix3_rotate_f16 :: proc "contextless" (angle_radians: f16, v: Vector3f16) ->
|
|
return rot
|
|
return rot
|
|
}
|
|
}
|
|
@(require_results)
|
|
@(require_results)
|
|
-matrix3_rotate_f32 :: proc "contextless" (angle_radians: f32, v: Vector3f32) -> (rot: Matrix3f32) #no_bounds_check {
|
|
|
|
|
|
+matrix3_rotate_f32 :: proc "contextless" (angle_radians: f32, v: Vector3f32) -> (rot: Matrix3f32) {
|
|
c := math.cos(angle_radians)
|
|
c := math.cos(angle_radians)
|
|
s := math.sin(angle_radians)
|
|
s := math.sin(angle_radians)
|
|
|
|
|
|
@@ -1575,7 +1575,7 @@ matrix3_rotate_f32 :: proc "contextless" (angle_radians: f32, v: Vector3f32) ->
|
|
return rot
|
|
return rot
|
|
}
|
|
}
|
|
@(require_results)
|
|
@(require_results)
|
|
-matrix3_rotate_f64 :: proc "contextless" (angle_radians: f64, v: Vector3f64) -> (rot: Matrix3f64) #no_bounds_check {
|
|
|
|
|
|
+matrix3_rotate_f64 :: proc "contextless" (angle_radians: f64, v: Vector3f64) -> (rot: Matrix3f64) {
|
|
c := math.cos(angle_radians)
|
|
c := math.cos(angle_radians)
|
|
s := math.sin(angle_radians)
|
|
s := math.sin(angle_radians)
|
|
|
|
|
|
@@ -1644,7 +1644,7 @@ matrix3_look_at :: proc{
|
|
|
|
|
|
|
|
|
|
@(require_results)
|
|
@(require_results)
|
|
-matrix4_from_quaternion_f16 :: proc "contextless" (q: Quaternionf16) -> (m: Matrix4f16) #no_bounds_check {
|
|
|
|
|
|
+matrix4_from_quaternion_f16 :: proc "contextless" (q: Quaternionf16) -> (m: Matrix4f16) {
|
|
qxx := q.x * q.x
|
|
qxx := q.x * q.x
|
|
qyy := q.y * q.y
|
|
qyy := q.y * q.y
|
|
qzz := q.z * q.z
|
|
qzz := q.z * q.z
|
|
@@ -1672,7 +1672,7 @@ matrix4_from_quaternion_f16 :: proc "contextless" (q: Quaternionf16) -> (m: Matr
|
|
return m
|
|
return m
|
|
}
|
|
}
|
|
@(require_results)
|
|
@(require_results)
|
|
-matrix4_from_quaternion_f32 :: proc "contextless" (q: Quaternionf32) -> (m: Matrix4f32) #no_bounds_check {
|
|
|
|
|
|
+matrix4_from_quaternion_f32 :: proc "contextless" (q: Quaternionf32) -> (m: Matrix4f32) {
|
|
qxx := q.x * q.x
|
|
qxx := q.x * q.x
|
|
qyy := q.y * q.y
|
|
qyy := q.y * q.y
|
|
qzz := q.z * q.z
|
|
qzz := q.z * q.z
|
|
@@ -1700,7 +1700,7 @@ matrix4_from_quaternion_f32 :: proc "contextless" (q: Quaternionf32) -> (m: Matr
|
|
return m
|
|
return m
|
|
}
|
|
}
|
|
@(require_results)
|
|
@(require_results)
|
|
-matrix4_from_quaternion_f64 :: proc "contextless" (q: Quaternionf64) -> (m: Matrix4f64) #no_bounds_check {
|
|
|
|
|
|
+matrix4_from_quaternion_f64 :: proc "contextless" (q: Quaternionf64) -> (m: Matrix4f64) {
|
|
qxx := q.x * q.x
|
|
qxx := q.x * q.x
|
|
qyy := q.y * q.y
|
|
qyy := q.y * q.y
|
|
qzz := q.z * q.z
|
|
qzz := q.z * q.z
|
|
@@ -1783,37 +1783,37 @@ matrix4_inverse :: proc{
|
|
|
|
|
|
|
|
|
|
@(require_results)
|
|
@(require_results)
|
|
-matrix4_minor_f16 :: proc "contextless" (m: Matrix4f16, row, col: int) -> f16 #no_bounds_check {
|
|
|
|
|
|
+matrix4_minor_f16 :: proc "contextless" (m: Matrix4f16, c, r: int) -> f16 {
|
|
cut_down: Matrix3f16
|
|
cut_down: Matrix3f16
|
|
- for j in 0..<3 {
|
|
|
|
- x := j if j < col else j+1
|
|
|
|
- for i in 0..<3 {
|
|
|
|
- y := i if i < row else i+1
|
|
|
|
- cut_down[i, j] = m[x, y]
|
|
|
|
|
|
+ for i in 0..<3 {
|
|
|
|
+ col := i if i < c else i+1
|
|
|
|
+ for j in 0..<3 {
|
|
|
|
+ row := j if j < r else j+1
|
|
|
|
+ cut_down[i][j] = m[col][row]
|
|
}
|
|
}
|
|
}
|
|
}
|
|
return matrix3_determinant(cut_down)
|
|
return matrix3_determinant(cut_down)
|
|
}
|
|
}
|
|
@(require_results)
|
|
@(require_results)
|
|
-matrix4_minor_f32 :: proc "contextless" (m: Matrix4f32, row, col: int) -> f32 #no_bounds_check {
|
|
|
|
|
|
+matrix4_minor_f32 :: proc "contextless" (m: Matrix4f32, c, r: int) -> f32 {
|
|
cut_down: Matrix3f32
|
|
cut_down: Matrix3f32
|
|
- for j in 0..<3 {
|
|
|
|
- x := j if j < col else j+1
|
|
|
|
- for i in 0..<3 {
|
|
|
|
- y := i if i < row else i+1
|
|
|
|
- cut_down[i, j] = m[x, y]
|
|
|
|
|
|
+ for i in 0..<3 {
|
|
|
|
+ col := i if i < c else i+1
|
|
|
|
+ for j in 0..<3 {
|
|
|
|
+ row := j if j < r else j+1
|
|
|
|
+ cut_down[i][j] = m[col][row]
|
|
}
|
|
}
|
|
}
|
|
}
|
|
return matrix3_determinant(cut_down)
|
|
return matrix3_determinant(cut_down)
|
|
}
|
|
}
|
|
@(require_results)
|
|
@(require_results)
|
|
-matrix4_minor_f64 :: proc "contextless" (m: Matrix4f64, row, col: int) -> f64 #no_bounds_check {
|
|
|
|
|
|
+matrix4_minor_f64 :: proc "contextless" (m: Matrix4f64, c, r: int) -> f64 {
|
|
cut_down: Matrix3f64
|
|
cut_down: Matrix3f64
|
|
- for j in 0..<3 {
|
|
|
|
- x := j if j < col else j+1
|
|
|
|
- for i in 0..<3 {
|
|
|
|
- y := i if i < row else i+1
|
|
|
|
- cut_down[i, j] = m[x, y]
|
|
|
|
|
|
+ for i in 0..<3 {
|
|
|
|
+ col := i if i < c else i+1
|
|
|
|
+ for j in 0..<3 {
|
|
|
|
+ row := j if j < r else j+1
|
|
|
|
+ cut_down[i][j] = m[col][row]
|
|
}
|
|
}
|
|
}
|
|
}
|
|
return matrix3_determinant(cut_down)
|
|
return matrix3_determinant(cut_down)
|
|
@@ -1826,24 +1826,24 @@ matrix4_minor :: proc{
|
|
|
|
|
|
|
|
|
|
@(require_results)
|
|
@(require_results)
|
|
-matrix4_cofactor_f16 :: proc "contextless" (m: Matrix4f16, row, col: int) -> f16 {
|
|
|
|
|
|
+matrix4_cofactor_f16 :: proc "contextless" (m: Matrix4f16, c, r: int) -> f16 {
|
|
sign, minor: f16
|
|
sign, minor: f16
|
|
- sign = 1 if (row + col) % 2 == 0 else -1
|
|
|
|
- minor = matrix4_minor(m, row, col)
|
|
|
|
|
|
+ sign = 1 if (c + r) % 2 == 0 else -1
|
|
|
|
+ minor = matrix4_minor(m, c, r)
|
|
return sign * minor
|
|
return sign * minor
|
|
}
|
|
}
|
|
@(require_results)
|
|
@(require_results)
|
|
-matrix4_cofactor_f32 :: proc "contextless" (m: Matrix4f32, row, col: int) -> f32 {
|
|
|
|
|
|
+matrix4_cofactor_f32 :: proc "contextless" (m: Matrix4f32, c, r: int) -> f32 {
|
|
sign, minor: f32
|
|
sign, minor: f32
|
|
- sign = 1 if (row + col) % 2 == 0 else -1
|
|
|
|
- minor = matrix4_minor(m, row, col)
|
|
|
|
|
|
+ sign = 1 if (c + r) % 2 == 0 else -1
|
|
|
|
+ minor = matrix4_minor(m, c, r)
|
|
return sign * minor
|
|
return sign * minor
|
|
}
|
|
}
|
|
@(require_results)
|
|
@(require_results)
|
|
-matrix4_cofactor_f64 :: proc "contextless" (m: Matrix4f64, row, col: int) -> f64 {
|
|
|
|
|
|
+matrix4_cofactor_f64 :: proc "contextless" (m: Matrix4f64, c, r: int) -> f64 {
|
|
sign, minor: f64
|
|
sign, minor: f64
|
|
- sign = 1 if (row + col) % 2 == 0 else -1
|
|
|
|
- minor = matrix4_minor(m, row, col)
|
|
|
|
|
|
+ sign = 1 if (c + r) % 2 == 0 else -1
|
|
|
|
+ minor = matrix4_minor(m, c, r)
|
|
return sign * minor
|
|
return sign * minor
|
|
}
|
|
}
|
|
matrix4_cofactor :: proc{
|
|
matrix4_cofactor :: proc{
|
|
@@ -1854,28 +1854,28 @@ matrix4_cofactor :: proc{
|
|
|
|
|
|
|
|
|
|
@(require_results)
|
|
@(require_results)
|
|
-matrix4_adjoint_f16 :: proc "contextless" (m: Matrix4f16) -> (adjoint: Matrix4f16) #no_bounds_check {
|
|
|
|
|
|
+matrix4_adjoint_f16 :: proc "contextless" (m: Matrix4f16) -> (adjoint: Matrix4f16) {
|
|
for i in 0..<4 {
|
|
for i in 0..<4 {
|
|
for j in 0..<4 {
|
|
for j in 0..<4 {
|
|
- adjoint[i, j] = matrix4_cofactor(m, i, j)
|
|
|
|
|
|
+ adjoint[i][j] = matrix4_cofactor(m, i, j)
|
|
}
|
|
}
|
|
}
|
|
}
|
|
return
|
|
return
|
|
}
|
|
}
|
|
@(require_results)
|
|
@(require_results)
|
|
-matrix4_adjoint_f32 :: proc "contextless" (m: Matrix4f32) -> (adjoint: Matrix4f32) #no_bounds_check {
|
|
|
|
|
|
+matrix4_adjoint_f32 :: proc "contextless" (m: Matrix4f32) -> (adjoint: Matrix4f32) {
|
|
for i in 0..<4 {
|
|
for i in 0..<4 {
|
|
for j in 0..<4 {
|
|
for j in 0..<4 {
|
|
- adjoint[i, j] = matrix4_cofactor(m, i, j)
|
|
|
|
|
|
+ adjoint[i][j] = matrix4_cofactor(m, i, j)
|
|
}
|
|
}
|
|
}
|
|
}
|
|
return
|
|
return
|
|
}
|
|
}
|
|
@(require_results)
|
|
@(require_results)
|
|
-matrix4_adjoint_f64 :: proc "contextless" (m: Matrix4f64) -> (adjoint: Matrix4f64) #no_bounds_check {
|
|
|
|
|
|
+matrix4_adjoint_f64 :: proc "contextless" (m: Matrix4f64) -> (adjoint: Matrix4f64) {
|
|
for i in 0..<4 {
|
|
for i in 0..<4 {
|
|
for j in 0..<4 {
|
|
for j in 0..<4 {
|
|
- adjoint[i, j] = matrix4_cofactor(m, i, j)
|
|
|
|
|
|
+ adjoint[i][j] = matrix4_cofactor(m, i, j)
|
|
}
|
|
}
|
|
}
|
|
}
|
|
return
|
|
return
|
|
@@ -1888,26 +1888,26 @@ matrix4_adjoint :: proc{
|
|
|
|
|
|
|
|
|
|
@(require_results)
|
|
@(require_results)
|
|
-matrix4_determinant_f16 :: proc "contextless" (m: Matrix4f16) -> (determinant: f16) #no_bounds_check {
|
|
|
|
|
|
+matrix4_determinant_f16 :: proc "contextless" (m: Matrix4f16) -> (determinant: f16) {
|
|
adjoint := matrix4_adjoint(m)
|
|
adjoint := matrix4_adjoint(m)
|
|
for i in 0..<4 {
|
|
for i in 0..<4 {
|
|
- determinant += m[0, i] * adjoint[0, i]
|
|
|
|
|
|
+ determinant += m[i][0] * adjoint[i][0]
|
|
}
|
|
}
|
|
return
|
|
return
|
|
}
|
|
}
|
|
@(require_results)
|
|
@(require_results)
|
|
-matrix4_determinant_f32 :: proc "contextless" (m: Matrix4f32) -> (determinant: f32) #no_bounds_check {
|
|
|
|
|
|
+matrix4_determinant_f32 :: proc "contextless" (m: Matrix4f32) -> (determinant: f32) {
|
|
adjoint := matrix4_adjoint(m)
|
|
adjoint := matrix4_adjoint(m)
|
|
for i in 0..<4 {
|
|
for i in 0..<4 {
|
|
- determinant += m[0, i] * adjoint[0, i]
|
|
|
|
|
|
+ determinant += m[i][0] * adjoint[i][0]
|
|
}
|
|
}
|
|
return
|
|
return
|
|
}
|
|
}
|
|
@(require_results)
|
|
@(require_results)
|
|
-matrix4_determinant_f64 :: proc "contextless" (m: Matrix4f64) -> (determinant: f64) #no_bounds_check {
|
|
|
|
|
|
+matrix4_determinant_f64 :: proc "contextless" (m: Matrix4f64) -> (determinant: f64) {
|
|
adjoint := matrix4_adjoint(m)
|
|
adjoint := matrix4_adjoint(m)
|
|
for i in 0..<4 {
|
|
for i in 0..<4 {
|
|
- determinant += m[0, i] * adjoint[0, i]
|
|
|
|
|
|
+ determinant += m[i][0] * adjoint[i][0]
|
|
}
|
|
}
|
|
return
|
|
return
|
|
}
|
|
}
|
|
@@ -1919,46 +1919,46 @@ matrix4_determinant :: proc{
|
|
|
|
|
|
|
|
|
|
@(require_results)
|
|
@(require_results)
|
|
-matrix4_inverse_transpose_f16 :: proc "contextless" (m: Matrix4f16) -> (inverse_transpose: Matrix4f16) #no_bounds_check {
|
|
|
|
|
|
+matrix4_inverse_transpose_f16 :: proc "contextless" (m: Matrix4f16) -> (inverse_transpose: Matrix4f16) {
|
|
adjoint := matrix4_adjoint(m)
|
|
adjoint := matrix4_adjoint(m)
|
|
determinant: f16 = 0
|
|
determinant: f16 = 0
|
|
for i in 0..<4 {
|
|
for i in 0..<4 {
|
|
- determinant += m[0, i] * adjoint[0, i]
|
|
|
|
|
|
+ determinant += m[i][0] * adjoint[i][0]
|
|
}
|
|
}
|
|
inv_determinant := 1.0 / determinant
|
|
inv_determinant := 1.0 / determinant
|
|
for i in 0..<4 {
|
|
for i in 0..<4 {
|
|
for j in 0..<4 {
|
|
for j in 0..<4 {
|
|
- inverse_transpose[i, j] = adjoint[i, j] * inv_determinant
|
|
|
|
|
|
+ inverse_transpose[i][j] = adjoint[i][j] * inv_determinant
|
|
}
|
|
}
|
|
}
|
|
}
|
|
return
|
|
return
|
|
}
|
|
}
|
|
@(require_results)
|
|
@(require_results)
|
|
-matrix4_inverse_transpose_f32 :: proc "contextless" (m: Matrix4f32) -> (inverse_transpose: Matrix4f32) #no_bounds_check {
|
|
|
|
|
|
+matrix4_inverse_transpose_f32 :: proc "contextless" (m: Matrix4f32) -> (inverse_transpose: Matrix4f32) {
|
|
adjoint := matrix4_adjoint(m)
|
|
adjoint := matrix4_adjoint(m)
|
|
determinant: f32 = 0
|
|
determinant: f32 = 0
|
|
for i in 0..<4 {
|
|
for i in 0..<4 {
|
|
- determinant += m[0, i] * adjoint[0, i]
|
|
|
|
|
|
+ determinant += m[i][0] * adjoint[i][0]
|
|
}
|
|
}
|
|
inv_determinant := 1.0 / determinant
|
|
inv_determinant := 1.0 / determinant
|
|
for i in 0..<4 {
|
|
for i in 0..<4 {
|
|
for j in 0..<4 {
|
|
for j in 0..<4 {
|
|
- inverse_transpose[i, j] = adjoint[i, j] * inv_determinant
|
|
|
|
|
|
+ inverse_transpose[i][j] = adjoint[i][j] * inv_determinant
|
|
}
|
|
}
|
|
}
|
|
}
|
|
return
|
|
return
|
|
}
|
|
}
|
|
@(require_results)
|
|
@(require_results)
|
|
-matrix4_inverse_transpose_f64 :: proc "contextless" (m: Matrix4f64) -> (inverse_transpose: Matrix4f64) #no_bounds_check {
|
|
|
|
|
|
+matrix4_inverse_transpose_f64 :: proc "contextless" (m: Matrix4f64) -> (inverse_transpose: Matrix4f64) {
|
|
adjoint := matrix4_adjoint(m)
|
|
adjoint := matrix4_adjoint(m)
|
|
determinant: f64 = 0
|
|
determinant: f64 = 0
|
|
for i in 0..<4 {
|
|
for i in 0..<4 {
|
|
- determinant += m[0, i] * adjoint[0, i]
|
|
|
|
|
|
+ determinant += m[i][0] * adjoint[i][0]
|
|
}
|
|
}
|
|
inv_determinant := 1.0 / determinant
|
|
inv_determinant := 1.0 / determinant
|
|
for i in 0..<4 {
|
|
for i in 0..<4 {
|
|
for j in 0..<4 {
|
|
for j in 0..<4 {
|
|
- inverse_transpose[i, j] = adjoint[i, j] * inv_determinant
|
|
|
|
|
|
+ inverse_transpose[i][j] = adjoint[i][j] * inv_determinant
|
|
}
|
|
}
|
|
}
|
|
}
|
|
return
|
|
return
|
|
@@ -1973,25 +1973,25 @@ matrix4_inverse_transpose :: proc{
|
|
@(require_results)
|
|
@(require_results)
|
|
matrix4_translate_f16 :: proc "contextless" (v: Vector3f16) -> Matrix4f16 {
|
|
matrix4_translate_f16 :: proc "contextless" (v: Vector3f16) -> Matrix4f16 {
|
|
m := MATRIX4F16_IDENTITY
|
|
m := MATRIX4F16_IDENTITY
|
|
- m[0, 3] = v[0]
|
|
|
|
- m[1, 3] = v[1]
|
|
|
|
- m[2, 3] = v[2]
|
|
|
|
|
|
+ m[3][0] = v[0]
|
|
|
|
+ m[3][1] = v[1]
|
|
|
|
+ m[3][2] = v[2]
|
|
return m
|
|
return m
|
|
}
|
|
}
|
|
@(require_results)
|
|
@(require_results)
|
|
matrix4_translate_f32 :: proc "contextless" (v: Vector3f32) -> Matrix4f32 {
|
|
matrix4_translate_f32 :: proc "contextless" (v: Vector3f32) -> Matrix4f32 {
|
|
m := MATRIX4F32_IDENTITY
|
|
m := MATRIX4F32_IDENTITY
|
|
- m[0, 3] = v[0]
|
|
|
|
- m[1, 3] = v[1]
|
|
|
|
- m[2, 3] = v[2]
|
|
|
|
|
|
+ m[3][0] = v[0]
|
|
|
|
+ m[3][1] = v[1]
|
|
|
|
+ m[3][2] = v[2]
|
|
return m
|
|
return m
|
|
}
|
|
}
|
|
@(require_results)
|
|
@(require_results)
|
|
matrix4_translate_f64 :: proc "contextless" (v: Vector3f64) -> Matrix4f64 {
|
|
matrix4_translate_f64 :: proc "contextless" (v: Vector3f64) -> Matrix4f64 {
|
|
m := MATRIX4F64_IDENTITY
|
|
m := MATRIX4F64_IDENTITY
|
|
- m[0, 3] = v[0]
|
|
|
|
- m[1, 3] = v[1]
|
|
|
|
- m[2, 3] = v[2]
|
|
|
|
|
|
+ m[3][0] = v[0]
|
|
|
|
+ m[3][1] = v[1]
|
|
|
|
+ m[3][2] = v[2]
|
|
return m
|
|
return m
|
|
}
|
|
}
|
|
matrix4_translate :: proc{
|
|
matrix4_translate :: proc{
|
|
@@ -2002,85 +2002,85 @@ matrix4_translate :: proc{
|
|
|
|
|
|
|
|
|
|
@(require_results)
|
|
@(require_results)
|
|
-matrix4_rotate_f16 :: proc "contextless" (angle_radians: f16, v: Vector3f16) -> (rot: Matrix4f16) #no_bounds_check {
|
|
|
|
|
|
+matrix4_rotate_f16 :: proc "contextless" (angle_radians: f16, v: Vector3f16) -> Matrix4f16 {
|
|
c := math.cos(angle_radians)
|
|
c := math.cos(angle_radians)
|
|
s := math.sin(angle_radians)
|
|
s := math.sin(angle_radians)
|
|
|
|
|
|
a := normalize(v)
|
|
a := normalize(v)
|
|
t := a * (1-c)
|
|
t := a * (1-c)
|
|
|
|
|
|
- rot = 1
|
|
|
|
|
|
+ rot := MATRIX4F16_IDENTITY
|
|
|
|
|
|
- rot[0, 0] = c + t[0]*a[0]
|
|
|
|
- rot[1, 0] = 0 + t[0]*a[1] + s*a[2]
|
|
|
|
- rot[2, 0] = 0 + t[0]*a[2] - s*a[1]
|
|
|
|
- rot[3, 0] = 0
|
|
|
|
|
|
+ rot[0][0] = c + t[0]*a[0]
|
|
|
|
+ rot[0][1] = 0 + t[0]*a[1] + s*a[2]
|
|
|
|
+ rot[0][2] = 0 + t[0]*a[2] - s*a[1]
|
|
|
|
+ rot[0][3] = 0
|
|
|
|
|
|
- rot[0, 1] = 0 + t[1]*a[0] - s*a[2]
|
|
|
|
- rot[1, 1] = c + t[1]*a[1]
|
|
|
|
- rot[2, 1] = 0 + t[1]*a[2] + s*a[0]
|
|
|
|
- rot[3, 1] = 0
|
|
|
|
|
|
+ rot[1][0] = 0 + t[1]*a[0] - s*a[2]
|
|
|
|
+ rot[1][1] = c + t[1]*a[1]
|
|
|
|
+ rot[1][2] = 0 + t[1]*a[2] + s*a[0]
|
|
|
|
+ rot[1][3] = 0
|
|
|
|
|
|
- rot[0, 2] = 0 + t[2]*a[0] + s*a[1]
|
|
|
|
- rot[1, 2] = 0 + t[2]*a[1] - s*a[0]
|
|
|
|
- rot[2, 2] = c + t[2]*a[2]
|
|
|
|
- rot[3, 2] = 0
|
|
|
|
|
|
+ rot[2][0] = 0 + t[2]*a[0] + s*a[1]
|
|
|
|
+ rot[2][1] = 0 + t[2]*a[1] - s*a[0]
|
|
|
|
+ rot[2][2] = c + t[2]*a[2]
|
|
|
|
+ rot[2][3] = 0
|
|
|
|
|
|
- return
|
|
|
|
|
|
+ return rot
|
|
}
|
|
}
|
|
@(require_results)
|
|
@(require_results)
|
|
-matrix4_rotate_f32 :: proc "contextless" (angle_radians: f32, v: Vector3f32) -> (rot: Matrix4f32) #no_bounds_check {
|
|
|
|
|
|
+matrix4_rotate_f32 :: proc "contextless" (angle_radians: f32, v: Vector3f32) -> Matrix4f32 {
|
|
c := math.cos(angle_radians)
|
|
c := math.cos(angle_radians)
|
|
s := math.sin(angle_radians)
|
|
s := math.sin(angle_radians)
|
|
|
|
|
|
a := normalize(v)
|
|
a := normalize(v)
|
|
t := a * (1-c)
|
|
t := a * (1-c)
|
|
|
|
|
|
- rot = 1
|
|
|
|
|
|
+ rot := MATRIX4F32_IDENTITY
|
|
|
|
|
|
- rot[0, 0] = c + t[0]*a[0]
|
|
|
|
- rot[1, 0] = 0 + t[0]*a[1] + s*a[2]
|
|
|
|
- rot[2, 0] = 0 + t[0]*a[2] - s*a[1]
|
|
|
|
- rot[3, 0] = 0
|
|
|
|
|
|
+ rot[0][0] = c + t[0]*a[0]
|
|
|
|
+ rot[0][1] = 0 + t[0]*a[1] + s*a[2]
|
|
|
|
+ rot[0][2] = 0 + t[0]*a[2] - s*a[1]
|
|
|
|
+ rot[0][3] = 0
|
|
|
|
|
|
- rot[0, 1] = 0 + t[1]*a[0] - s*a[2]
|
|
|
|
- rot[1, 1] = c + t[1]*a[1]
|
|
|
|
- rot[2, 1] = 0 + t[1]*a[2] + s*a[0]
|
|
|
|
- rot[3, 1] = 0
|
|
|
|
|
|
+ rot[1][0] = 0 + t[1]*a[0] - s*a[2]
|
|
|
|
+ rot[1][1] = c + t[1]*a[1]
|
|
|
|
+ rot[1][2] = 0 + t[1]*a[2] + s*a[0]
|
|
|
|
+ rot[1][3] = 0
|
|
|
|
|
|
- rot[0, 2] = 0 + t[2]*a[0] + s*a[1]
|
|
|
|
- rot[1, 2] = 0 + t[2]*a[1] - s*a[0]
|
|
|
|
- rot[2, 2] = c + t[2]*a[2]
|
|
|
|
- rot[3, 2] = 0
|
|
|
|
|
|
+ rot[2][0] = 0 + t[2]*a[0] + s*a[1]
|
|
|
|
+ rot[2][1] = 0 + t[2]*a[1] - s*a[0]
|
|
|
|
+ rot[2][2] = c + t[2]*a[2]
|
|
|
|
+ rot[2][3] = 0
|
|
|
|
|
|
- return
|
|
|
|
|
|
+ return rot
|
|
}
|
|
}
|
|
@(require_results)
|
|
@(require_results)
|
|
-matrix4_rotate_f64 :: proc "contextless" (angle_radians: f64, v: Vector3f64) -> (rot: Matrix4f64) #no_bounds_check {
|
|
|
|
|
|
+matrix4_rotate_f64 :: proc "contextless" (angle_radians: f64, v: Vector3f64) -> Matrix4f64 {
|
|
c := math.cos(angle_radians)
|
|
c := math.cos(angle_radians)
|
|
s := math.sin(angle_radians)
|
|
s := math.sin(angle_radians)
|
|
|
|
|
|
a := normalize(v)
|
|
a := normalize(v)
|
|
t := a * (1-c)
|
|
t := a * (1-c)
|
|
|
|
|
|
- rot = 1
|
|
|
|
|
|
+ rot := MATRIX4F64_IDENTITY
|
|
|
|
|
|
- rot[0, 0] = c + t[0]*a[0]
|
|
|
|
- rot[1, 0] = 0 + t[0]*a[1] + s*a[2]
|
|
|
|
- rot[2, 0] = 0 + t[0]*a[2] - s*a[1]
|
|
|
|
- rot[3, 0] = 0
|
|
|
|
|
|
+ rot[0][0] = c + t[0]*a[0]
|
|
|
|
+ rot[0][1] = 0 + t[0]*a[1] + s*a[2]
|
|
|
|
+ rot[0][2] = 0 + t[0]*a[2] - s*a[1]
|
|
|
|
+ rot[0][3] = 0
|
|
|
|
|
|
- rot[0, 1] = 0 + t[1]*a[0] - s*a[2]
|
|
|
|
- rot[1, 1] = c + t[1]*a[1]
|
|
|
|
- rot[2, 1] = 0 + t[1]*a[2] + s*a[0]
|
|
|
|
- rot[3, 1] = 0
|
|
|
|
|
|
+ rot[1][0] = 0 + t[1]*a[0] - s*a[2]
|
|
|
|
+ rot[1][1] = c + t[1]*a[1]
|
|
|
|
+ rot[1][2] = 0 + t[1]*a[2] + s*a[0]
|
|
|
|
+ rot[1][3] = 0
|
|
|
|
|
|
- rot[0, 2] = 0 + t[2]*a[0] + s*a[1]
|
|
|
|
- rot[1, 2] = 0 + t[2]*a[1] - s*a[0]
|
|
|
|
- rot[2, 2] = c + t[2]*a[2]
|
|
|
|
- rot[3, 2] = 0
|
|
|
|
|
|
+ rot[2][0] = 0 + t[2]*a[0] + s*a[1]
|
|
|
|
+ rot[2][1] = 0 + t[2]*a[1] - s*a[0]
|
|
|
|
+ rot[2][2] = c + t[2]*a[2]
|
|
|
|
+ rot[2][3] = 0
|
|
|
|
|
|
- return
|
|
|
|
|
|
+ return rot
|
|
}
|
|
}
|
|
matrix4_rotate :: proc{
|
|
matrix4_rotate :: proc{
|
|
matrix4_rotate_f16,
|
|
matrix4_rotate_f16,
|
|
@@ -2091,26 +2091,26 @@ matrix4_rotate :: proc{
|
|
|
|
|
|
@(require_results)
|
|
@(require_results)
|
|
matrix4_scale_f16 :: proc "contextless" (v: Vector3f16) -> (m: Matrix4f16) {
|
|
matrix4_scale_f16 :: proc "contextless" (v: Vector3f16) -> (m: Matrix4f16) {
|
|
- m[0, 0] = v[0]
|
|
|
|
- m[1, 1] = v[1]
|
|
|
|
- m[2, 2] = v[2]
|
|
|
|
- m[3, 3] = 1
|
|
|
|
|
|
+ m[0][0] = v[0]
|
|
|
|
+ m[1][1] = v[1]
|
|
|
|
+ m[2][2] = v[2]
|
|
|
|
+ m[3][3] = 1
|
|
return
|
|
return
|
|
}
|
|
}
|
|
@(require_results)
|
|
@(require_results)
|
|
matrix4_scale_f32 :: proc "contextless" (v: Vector3f32) -> (m: Matrix4f32) {
|
|
matrix4_scale_f32 :: proc "contextless" (v: Vector3f32) -> (m: Matrix4f32) {
|
|
- m[0, 0] = v[0]
|
|
|
|
- m[1, 1] = v[1]
|
|
|
|
- m[2, 2] = v[2]
|
|
|
|
- m[3, 3] = 1
|
|
|
|
|
|
+ m[0][0] = v[0]
|
|
|
|
+ m[1][1] = v[1]
|
|
|
|
+ m[2][2] = v[2]
|
|
|
|
+ m[3][3] = 1
|
|
return
|
|
return
|
|
}
|
|
}
|
|
@(require_results)
|
|
@(require_results)
|
|
matrix4_scale_f64 :: proc "contextless" (v: Vector3f64) -> (m: Matrix4f64) {
|
|
matrix4_scale_f64 :: proc "contextless" (v: Vector3f64) -> (m: Matrix4f64) {
|
|
- m[0, 0] = v[0]
|
|
|
|
- m[1, 1] = v[1]
|
|
|
|
- m[2, 2] = v[2]
|
|
|
|
- m[3, 3] = 1
|
|
|
|
|
|
+ m[0][0] = v[0]
|
|
|
|
+ m[1][1] = v[1]
|
|
|
|
+ m[2][2] = v[2]
|
|
|
|
+ m[3][3] = 1
|
|
return
|
|
return
|
|
}
|
|
}
|
|
matrix4_scale :: proc{
|
|
matrix4_scale :: proc{
|