oxiphysics_geometry/csg/
sdftorus_traits.rs1use super::functions::ImplicitSurface;
12use super::functions::normalize;
13use super::types::SdfTorus;
14
15impl ImplicitSurface for SdfTorus {
16 fn sdf(&self, p: [f64; 3]) -> f64 {
17 let q0 = (p[0] * p[0] + p[2] * p[2]).sqrt() - self.major_radius;
18 (q0 * q0 + p[1] * p[1]).sqrt() - self.minor_radius
19 }
20 fn gradient(&self, p: [f64; 3]) -> [f64; 3] {
21 const EPS: f64 = 1e-5;
22 let dx = self.sdf([p[0] + EPS, p[1], p[2]]) - self.sdf([p[0] - EPS, p[1], p[2]]);
23 let dy = self.sdf([p[0], p[1] + EPS, p[2]]) - self.sdf([p[0], p[1] - EPS, p[2]]);
24 let dz = self.sdf([p[0], p[1], p[2] + EPS]) - self.sdf([p[0], p[1], p[2] - EPS]);
25 normalize([dx, dy, dz])
26 }
27}