package runtime import "core:intrinsics" _ :: intrinsics @(builtin) determinant :: proc{ matrix1x1_determinant, matrix2x2_determinant, matrix3x3_determinant, matrix4x4_determinant, } @(builtin) adjugate :: proc{ matrix1x1_adjugate, matrix2x2_adjugate, matrix3x3_adjugate, matrix4x4_adjugate, } @(builtin) inverse_transpose :: proc{ matrix1x1_inverse_transpose, matrix2x2_inverse_transpose, matrix3x3_inverse_transpose, matrix4x4_inverse_transpose, } @(builtin) inverse :: proc{ matrix1x1_inverse, matrix2x2_inverse, matrix3x3_inverse, matrix4x4_inverse, } @(builtin, require_results) hermitian_adjoint :: proc "contextless" (m: $M/matrix[$N, N]$T) -> M where intrinsics.type_is_complex(T), N >= 1 { return conj(transpose(m)) } @(builtin, require_results) matrix_trace :: proc "contextless" (m: $M/matrix[$N, N]$T) -> (trace: T) { for i in 0.. (minor: T) where N > 1 { K :: N-1 cut_down: matrix[K, K]T for col_idx in 0..= column) for row_idx in 0..= row) cut_down[row_idx, col_idx] = m[i, j] } } return determinant(cut_down) } @(builtin, require_results) matrix1x1_determinant :: proc "contextless" (m: $M/matrix[1, 1]$T) -> (det: T) { return m[0, 0] } @(builtin, require_results) matrix2x2_determinant :: proc "contextless" (m: $M/matrix[2, 2]$T) -> (det: T) { return m[0, 0]*m[1, 1] - m[0, 1]*m[1, 0] } @(builtin, require_results) matrix3x3_determinant :: proc "contextless" (m: $M/matrix[3, 3]$T) -> (det: T) { 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]) c := +m[0, 2] * (m[1, 0] * m[2, 1] - m[1, 1] * m[2, 0]) return a + b + c } @(builtin, require_results) matrix4x4_determinant :: proc "contextless" (m: $M/matrix[4, 4]$T) -> (det: T) { a := adjugate(m) #no_bounds_check for i in 0..<4 { det += m[0, i] * a[0, i] } return } @(builtin, require_results) matrix1x1_adjugate :: proc "contextless" (x: $M/matrix[1, 1]$T) -> (y: M) { y = x return } @(builtin, require_results) matrix2x2_adjugate :: proc "contextless" (x: $M/matrix[2, 2]$T) -> (y: M) { y[0, 0] = +x[1, 1] y[0, 1] = -x[1, 0] y[1, 0] = -x[0, 1] y[1, 1] = +x[0, 0] return } @(builtin, require_results) matrix3x3_adjugate :: proc "contextless" (m: $M/matrix[3, 3]$T) -> (y: M) { y[0, 0] = +(m[1, 1] * m[2, 2] - m[2, 1] * m[1, 2]) y[0, 1] = -(m[1, 0] * m[2, 2] - m[2, 0] * m[1, 2]) y[0, 2] = +(m[1, 0] * m[2, 1] - m[2, 0] * m[1, 1]) y[1, 0] = -(m[0, 1] * m[2, 2] - m[2, 1] * m[0, 2]) y[1, 1] = +(m[0, 0] * m[2, 2] - m[2, 0] * m[0, 2]) y[1, 2] = -(m[0, 0] * m[2, 1] - m[2, 0] * m[0, 1]) y[2, 0] = +(m[0, 1] * m[1, 2] - m[1, 1] * m[0, 2]) y[2, 1] = -(m[0, 0] * m[1, 2] - m[1, 0] * m[0, 2]) y[2, 2] = +(m[0, 0] * m[1, 1] - m[1, 0] * m[0, 1]) return } @(builtin, require_results) matrix4x4_adjugate :: proc "contextless" (x: $M/matrix[4, 4]$T) -> (y: M) { for i in 0..<4 { for j in 0..<4 { sign: T = 1 if (i + j) % 2 == 0 else -1 y[i, j] = sign * matrix_minor(x, i, j) } } return } @(builtin, require_results) matrix1x1_inverse_transpose :: proc "contextless" (x: $M/matrix[1, 1]$T) -> (y: M) { y[0, 0] = 1/x[0, 0] return } @(builtin, require_results) matrix2x2_inverse_transpose :: proc "contextless" (x: $M/matrix[2, 2]$T) -> (y: M) { d := x[0, 0]*x[1, 1] - x[0, 1]*x[1, 0] when intrinsics.type_is_integer(T) { y[0, 0] = +x[1, 1] / d y[1, 0] = -x[0, 1] / d y[0, 1] = -x[1, 0] / d y[1, 1] = +x[0, 0] / d } else { id := 1 / d y[0, 0] = +x[1, 1] * id y[1, 0] = -x[0, 1] * id y[0, 1] = -x[1, 0] * id y[1, 1] = +x[0, 0] * id } return } @(builtin, require_results) matrix3x3_inverse_transpose :: proc "contextless" (x: $M/matrix[3, 3]$T) -> (y: M) #no_bounds_check { a := adjugate(x) d := determinant(x) when intrinsics.type_is_integer(T) { for i in 0..<3 { for j in 0..<3 { y[i, j] = a[i, j] / d } } } else { id := 1/d for i in 0..<3 { for j in 0..<3 { y[i, j] = a[i, j] * id } } } return } @(builtin, require_results) matrix4x4_inverse_transpose :: proc "contextless" (x: $M/matrix[4, 4]$T) -> (y: M) #no_bounds_check { a := adjugate(x) d: T for i in 0..<4 { d += x[0, i] * a[0, i] } when intrinsics.type_is_integer(T) { for i in 0..<4 { for j in 0..<4 { y[i, j] = a[i, j] / d } } } else { id := 1/d for i in 0..<4 { for j in 0..<4 { y[i, j] = a[i, j] * id } } } return } @(builtin, require_results) matrix1x1_inverse :: proc "contextless" (x: $M/matrix[1, 1]$T) -> (y: M) { y[0, 0] = 1/x[0, 0] return } @(builtin, require_results) matrix2x2_inverse :: proc "contextless" (x: $M/matrix[2, 2]$T) -> (y: M) { d := x[0, 0]*x[1, 1] - x[0, 1]*x[1, 0] when intrinsics.type_is_integer(T) { y[0, 0] = +x[1, 1] / d y[0, 1] = -x[0, 1] / d y[1, 0] = -x[1, 0] / d y[1, 1] = +x[0, 0] / d } else { id := 1 / d y[0, 0] = +x[1, 1] * id y[0, 1] = -x[0, 1] * id y[1, 0] = -x[1, 0] * id y[1, 1] = +x[0, 0] * id } return } @(builtin, require_results) matrix3x3_inverse :: proc "contextless" (x: $M/matrix[3, 3]$T) -> (y: M) #no_bounds_check { a := adjugate(x) d := determinant(x) when intrinsics.type_is_integer(T) { for i in 0..<3 { for j in 0..<3 { y[i, j] = a[j, i] / d } } } else { id := 1/d for i in 0..<3 { for j in 0..<3 { y[i, j] = a[j, i] * id } } } return } @(builtin, require_results) matrix4x4_inverse :: proc "contextless" (x: $M/matrix[4, 4]$T) -> (y: M) #no_bounds_check { a := adjugate(x) d: T for i in 0..<4 { d += x[0, i] * a[0, i] } when intrinsics.type_is_integer(T) { for i in 0..<4 { for j in 0..<4 { y[i, j] = a[j, i] / d } } } else { id := 1/d for i in 0..<4 { for j in 0..<4 { y[i, j] = a[j, i] * id } } } return }