use glam::{Vec2, Vec3};
#[inline(always)]
pub fn sdf_vesica(p: Vec3, radius: f32, half_dist: f32) -> f32 {
let q = Vec2::new(p.x.hypot(p.z), p.y.abs());
let b = radius
.mul_add(radius, -(half_dist * half_dist))
.max(0.0)
.sqrt();
if (q.y - b) * half_dist > q.x * b {
(q - Vec2::new(0.0, b)).length()
} else {
(q - Vec2::new(-half_dist, 0.0)).length() - radius
}
}
#[cfg(test)]
mod tests {
use super::*;
#[test]
fn test_vesica_origin() {
let d = sdf_vesica(Vec3::ZERO, 1.0, 0.5);
assert!(d < 0.0, "Origin should be inside, got {}", d);
}
#[test]
fn test_vesica_outside() {
let d = sdf_vesica(Vec3::new(5.0, 0.0, 0.0), 1.0, 0.5);
assert!(d > 0.0, "Far point should be outside, got {}", d);
}
#[test]
fn test_vesica_symmetry_y() {
let d1 = sdf_vesica(Vec3::new(0.2, 0.3, 0.1), 1.0, 0.5);
let d2 = sdf_vesica(Vec3::new(0.2, -0.3, 0.1), 1.0, 0.5);
assert!((d1 - d2).abs() < 0.001, "Should be symmetric in Y");
}
#[test]
fn test_vesica_sphere_degenerate() {
let d = sdf_vesica(Vec3::new(2.0, 0.0, 0.0), 1.0, 0.0);
let d_sphere = Vec3::new(2.0, 0.0, 0.0).length() - 1.0;
assert!(
(d - d_sphere).abs() < 0.1,
"Zero dist should be ~sphere, got {}",
d
);
}
}