implement feature_normal_at_point for trimesh

src/shape/shape.rs

@@ -1130,6 +1130,14 @@ impl Shape for TriMesh {
         Real::frac_pi_4()
     }
 
+    fn feature_normal_at_point(
+        &self,
+        feature: FeatureId,
+        point: &Point<Real>,
+    ) -> Option<Unit<Vector<Real>>> {
+        self.feature_normal_at_point(feature, point)
+    }
+
     #[cfg(feature = "std")]
     fn as_composite_shape(&self) -> Option<&dyn SimdCompositeShape> {
         Some(self as &dyn SimdCompositeShape)

src/shape/trimesh.rs

@@ -848,6 +848,21 @@ impl TriMesh {
             )
         })
     }
+
+    #[cfg(feature = "dim3")]
+    /// Gets the normal of the triangle represented by `feature`.
+    pub fn feature_normal_at_point(
+        &self,
+        feature: FeatureId,
+        _point: &Point<Real>,
+    ) -> Option<Unit<Vector<Real>>> {
+        match feature {
+            FeatureId::Face(i) => self
+                .triangle(i % self.num_triangles() as u32)
+                .feature_normal(FeatureId::Face(0)),
+            _ => None,
+        }
+    }
 }
 
 impl TriMesh {