pub fn add_3d(a: [f64; 3], b: [f64; 3]) -> [f64; 3] {
[a[0] + b[0], a[1] + b[1], a[2] + b[2]]
}
pub fn subtract_3d(a: [f64; 3], b: [f64; 3]) -> [f64; 3] {
[a[0] - b[0], a[1] - b[1], a[2] - b[2]]
}
pub fn dot_3d(a: [f64; 3], b: [f64; 3]) -> f64 {
a[0] * b[0] + a[1] * b[1] + a[2] * b[2]
}
pub fn cross_3d(a: [f64; 3], b: [f64; 3]) -> [f64; 3] {
[
a[1] * b[2] - a[2] * b[1],
a[2] * b[0] - a[0] * b[2],
a[0] * b[1] - a[1] * b[0],
]
}
pub fn scale_3d(a: [f64; 3], scalar: f64) -> [f64; 3] {
[a[0] * scalar, a[1] * scalar, a[2] * scalar]
}
pub fn magnitude_3d(a: [f64; 3]) -> f64 {
(a[0] * a[0] + a[1] * a[1] + a[2] * a[2]).sqrt()
}
pub fn normalize_3d(a: [f64; 3]) -> [f64; 3] {
let mag = magnitude_3d(a);
scale_3d(a, 1.0 / mag)
}