parry3d/query/point/
point_cuboid.rs

1use crate::bounding_volume::Aabb;
2use crate::math::{Point, Real};
3use crate::query::{PointProjection, PointQuery};
4use crate::shape::{Cuboid, FeatureId};
5
6impl PointQuery for Cuboid {
7    #[inline]
8    fn project_local_point(&self, pt: &Point<Real>, solid: bool) -> PointProjection {
9        let dl = Point::from(-self.half_extents);
10        let ur = Point::from(self.half_extents);
11        Aabb::new(dl, ur).project_local_point(pt, solid)
12    }
13
14    #[inline]
15    fn project_local_point_and_get_feature(
16        &self,
17        pt: &Point<Real>,
18    ) -> (PointProjection, FeatureId) {
19        let dl = Point::from(-self.half_extents);
20        let ur = Point::from(self.half_extents);
21        Aabb::new(dl, ur).project_local_point_and_get_feature(pt)
22    }
23
24    #[inline]
25    fn distance_to_local_point(&self, pt: &Point<Real>, solid: bool) -> Real {
26        let dl = Point::from(-self.half_extents);
27        let ur = Point::from(self.half_extents);
28        Aabb::new(dl, ur).distance_to_local_point(pt, solid)
29    }
30
31    #[inline]
32    fn contains_local_point(&self, pt: &Point<Real>) -> bool {
33        let dl = Point::from(-self.half_extents);
34        let ur = Point::from(self.half_extents);
35        Aabb::new(dl, ur).contains_local_point(pt)
36    }
37}