use glam::Vec3;
#[inline(always)]
pub fn sdf_frd(p: Vec3, scale: f32, thickness: f32) -> f32 {
let sp = p * scale;
let (sx, cx) = sp.x.sin_cos();
let (sy, cy) = sp.y.sin_cos();
let (sz, cz) = sp.z.sin_cos();
let c2x = (2.0 * cx).mul_add(cx, -1.0);
let c2y = (2.0 * cy).mul_add(cy, -1.0);
let c2z = (2.0 * cz).mul_add(cz, -1.0);
let d = (sx * cy).mul_add(c2z, (c2x * sy).mul_add(cz, cx * c2y * sz));
d.abs() / scale - thickness
}
#[cfg(test)]
mod tests {
use super::*;
#[test]
fn test_frd_origin() {
let d = sdf_frd(Vec3::ZERO, 1.0, 0.1);
assert!(
(d + 0.1).abs() < 0.01,
"Origin on surface minus thickness, got {}",
d
);
}
#[test]
fn test_frd_periodicity() {
let tau = 2.0 * std::f32::consts::PI;
let d1 = sdf_frd(Vec3::new(0.5, 0.3, 0.7), 1.0, 0.1);
let d2 = sdf_frd(Vec3::new(0.5 + tau, 0.3 + tau, 0.7 + tau), 1.0, 0.1);
assert!((d1 - d2).abs() < 0.01, "Should be periodic");
}
#[test]
fn test_frd_finite() {
let d = sdf_frd(Vec3::new(1.0, 2.0, 3.0), 2.0, 0.05);
assert!(d.is_finite());
}
}