use glam::{Vec2, Vec3};
#[inline(always)]
pub fn sdf_pie(p: Vec3, angle: f32, radius: f32, half_height: f32) -> f32 {
let qx = p.x.abs();
let qz = p.z;
let q = Vec2::new(qx, qz);
let sc = Vec2::new(alice_det_math::sin(angle), alice_det_math::cos(angle));
let l = q.length() - radius;
let dot_qc = super::clamp_total(q.dot(sc), 0.0, radius);
let m = (q - sc * dot_qc).length();
let cross_val = sc.y * qx + -(sc.x * qz);
let s = if cross_val > 0.0 {
1.0
} else if cross_val < 0.0 {
-1.0
} else {
0.0
};
let d_2d = l.max(m * s);
let d_y = p.y.abs() - half_height;
let w = Vec2::new(d_2d.max(0.0), d_y.max(0.0));
d_2d.max(d_y).min(0.0) + w.length()
}
#[cfg(test)]
mod tests {
use super::*;
#[test]
fn test_pie_inside() {
let d = sdf_pie(
Vec3::new(0.0, 0.0, 0.5),
std::f32::consts::FRAC_PI_4,
1.0,
0.5,
);
assert!(d < 0.0, "Interior point should be inside, got {}", d);
}
#[test]
fn test_pie_far_outside() {
let d = sdf_pie(
Vec3::new(5.0, 0.0, 0.0),
std::f32::consts::FRAC_PI_4,
1.0,
0.5,
);
assert!(d > 0.0, "Far point should be outside, got {}", d);
}
#[test]
fn test_pie_symmetry_y() {
let d1 = sdf_pie(
Vec3::new(0.1, 0.2, 0.5),
std::f32::consts::FRAC_PI_4,
1.0,
0.5,
);
let d2 = sdf_pie(
Vec3::new(0.1, -0.2, 0.5),
std::f32::consts::FRAC_PI_4,
1.0,
0.5,
);
assert!((d1 - d2).abs() < 0.001, "Should be symmetric in Y");
}
#[test]
fn test_pie_symmetry_x() {
let d1 = sdf_pie(
Vec3::new(0.2, 0.1, 0.5),
std::f32::consts::FRAC_PI_4,
1.0,
0.5,
);
let d2 = sdf_pie(
Vec3::new(-0.2, 0.1, 0.5),
std::f32::consts::FRAC_PI_4,
1.0,
0.5,
);
assert!((d1 - d2).abs() < 0.001, "Should be symmetric in X");
}
}