Skip to main content

oxiphysics_geometry/implicit_geometry/
sdfpyramid_traits.rs

1//! # SdfPyramid - Trait Implementations
2//!
3//! This module contains trait implementations for `SdfPyramid`.
4//!
5//! ## Implemented Traits
6//!
7//! - `Sdf`
8//!
9//! 🤖 Generated with [SplitRS](https://github.com/cool-japan/splitrs)
10
11use super::functions::*;
12use super::types::SdfPyramid;
13
14impl Sdf for SdfPyramid {
15    fn dist(&self, p: [f64; 3]) -> f64 {
16        let m2 = self.half_base * self.half_base + self.height * self.height;
17        let px = p[0].abs();
18        let pz = p[2].abs();
19        let (px, pz) = if pz > px { (pz, px) } else { (px, pz) };
20        let px = px - self.half_base;
21        let py = p[1] - self.height;
22        let k = clamp_f(-py * self.half_base - px * self.height, 0.0, m2);
23        let dx = px - (-self.half_base * k / m2);
24        let dy = py - self.height * k / m2;
25        let d1 = ((px * self.height - py * (-self.half_base)).max(0.0).powi(2)
26            + (pz + self.half_base).max(0.0).powi(2))
27        .sqrt();
28        let d2 = len2([dx, dy]);
29        let s = if px * (-self.height) - py * (-self.half_base) > 0.0 {
30            -1.0
31        } else {
32            1.0
33        };
34        _ = d1;
35        s * d2.min(d1)
36    }
37}