oxiphysics_geometry/implicit_geometry/
sdfhexagonalprism_traits.rs1use super::functions::*;
12use super::types::SdfHexagonalPrism;
13
14impl Sdf for SdfHexagonalPrism {
15 fn dist(&self, p: [f64; 3]) -> f64 {
16 let k0 = -3.0_f64.sqrt() / 2.0;
17 let k1 = 0.5_f64;
18 let k2 = 1.0_f64 / 3.0_f64.sqrt();
19 let qa = [p[0].abs(), p[2].abs()];
20 let dot_val = 2.0_f64.min(0.0_f64.max(k0 * qa[0] + k1 * qa[1]));
21 let qx = qa[0] - 2.0 * k0 * dot_val;
22 let qz = qa[1] - 2.0 * k1 * dot_val;
23 let ex = qx - clamp_f(qx, -k2 * self.radius, k2 * self.radius);
24 let ez = qz - self.radius;
25 let d_xz = len2([ex, ez]) * if qz > self.radius { 1.0 } else { -1.0 };
26 let d_y = p[1].abs() - self.half_height;
27 let d_xz_pos = d_xz.max(0.0);
28 let d_y_pos = d_y.max(0.0);
29 len2([d_xz_pos, d_y_pos]) + d_xz.min(0.0).max(d_y.min(0.0))
30 }
31}