use super::error::LightProbeError;
pub(super) const LP_SH_C0: f32 = 0.282_094_8_f32;
pub(super) const LP_SH_C1: f32 = 0.488_602_52_f32;
const LP_SH_C2: [f32; 5] = [
1.092_548_5_f32, 1.092_548_5_f32, 0.315_391_57_f32, 1.092_548_5_f32, 0.546_274_24_f32, ];
#[inline]
pub fn lp_normalize_dir(dir: [f32; 3]) -> Result<[f32; 3], LightProbeError> {
let [x, y, z] = dir;
let norm = (x * x + y * y + z * z).sqrt();
if norm < 1e-7 {
return Err(LightProbeError::ZeroDirection);
}
Ok([x / norm, y / norm, z / norm])
}
#[inline]
pub fn lp_sh_basis_l0(_dir: [f32; 3]) -> [f32; 1] {
[LP_SH_C0]
}
#[inline]
pub fn lp_sh_basis_l1(dir: [f32; 3]) -> [f32; 3] {
let [x, y, z] = dir;
[LP_SH_C1 * y, LP_SH_C1 * z, LP_SH_C1 * x]
}
#[inline]
pub fn lp_sh_basis_l2(dir: [f32; 3]) -> [f32; 5] {
let [x, y, z] = dir;
[
LP_SH_C2[0] * x * y,
LP_SH_C2[1] * y * z,
LP_SH_C2[2] * (2.0 * z * z - x * x - y * y),
LP_SH_C2[3] * x * z,
LP_SH_C2[4] * (x * x - y * y),
]
}
pub fn lp_sh_basis(dir: [f32; 3], order: usize) -> Result<Vec<f32>, LightProbeError> {
let d = lp_normalize_dir(dir)?;
match order {
1 => Ok(lp_sh_basis_l0(d).to_vec()),
2 => {
let mut v = Vec::with_capacity(4);
v.extend_from_slice(&lp_sh_basis_l0(d));
v.extend_from_slice(&lp_sh_basis_l1(d));
Ok(v)
}
3 => {
let mut v = Vec::with_capacity(9);
v.extend_from_slice(&lp_sh_basis_l0(d));
v.extend_from_slice(&lp_sh_basis_l1(d));
v.extend_from_slice(&lp_sh_basis_l2(d));
Ok(v)
}
_ => Err(LightProbeError::InvalidOrder { order }),
}
}
#[inline]
pub(super) fn lp_sh_full_9(dir: [f32; 3]) -> [f32; 9] {
let l0 = lp_sh_basis_l0(dir);
let l1 = lp_sh_basis_l1(dir);
let l2 = lp_sh_basis_l2(dir);
[
l0[0], l1[0], l1[1], l1[2], l2[0], l2[1], l2[2], l2[3], l2[4],
]
}