1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
use crate::{
AxisAlignedBoundingBox, BoundedGeometry, ConvexPolyhedron, Distance, Quad3d, SignedDistance, SignedDistanceResult,
};
use fenris_traits::Real;
use nalgebra::{OPoint, Point3, Scalar, U3};
use numeric_literals::replace_float_literals;
#[derive(Debug, Copy, Clone, PartialEq, Hash)]
pub struct Hexahedron<T>
where
T: Scalar,
{
vertices: [Point3<T>; 8],
}
impl<T> BoundedGeometry<T> for Hexahedron<T>
where
T: Real,
{
type Dimension = U3;
fn bounding_box(&self) -> AxisAlignedBoundingBox<T, U3> {
AxisAlignedBoundingBox::from_points(&self.vertices).unwrap()
}
}
impl<T> Hexahedron<T>
where
T: Scalar,
{
pub fn from_vertices(vertices: [Point3<T>; 8]) -> Self {
Self { vertices }
}
}
impl<T> Hexahedron<T>
where
T: Real,
{
#[replace_float_literals(T::from_f64(literal).unwrap())]
pub fn reference() -> Self {
Self::from_vertices([
Point3::new(-1.0, -1.0, -1.0),
Point3::new(1.0, -1.0, -1.0),
Point3::new(1.0, 1.0, -1.0),
Point3::new(-1.0, 1.0, -1.0),
Point3::new(-1.0, -1.0, 1.0),
Point3::new(1.0, -1.0, 1.0),
Point3::new(1.0, 1.0, 1.0),
Point3::new(-1.0, 1.0, 1.0),
])
}
}
impl<T> Distance<T, Point3<T>> for Hexahedron<T>
where
T: Real,
{
fn distance(&self, point: &Point3<T>) -> T {
let signed_dist = self.compute_signed_distance(point).signed_distance;
T::max(signed_dist, T::zero())
}
}
impl<T> SignedDistance<T, U3> for Hexahedron<T>
where
T: Real,
{
fn query_signed_distance(&self, point: &OPoint<T, U3>) -> Option<SignedDistanceResult<T, U3>> {
Some(self.compute_signed_distance(point))
}
}
impl<'a, T> ConvexPolyhedron<'a, T> for Hexahedron<T>
where
T: Real,
{
type Face = Quad3d<T>;
fn num_faces(&self) -> usize {
6
}
fn get_face(&self, index: usize) -> Option<Self::Face> {
let v = &self.vertices;
let quad = |i, j, k, l| Some(Quad3d::from_vertices([v[i], v[j], v[k], v[l]]));
match index {
0 => quad(0, 1, 2, 3),
1 => quad(4, 5, 1, 0),
2 => quad(5, 6, 2, 1),
3 => quad(6, 7, 3, 2),
4 => quad(0, 3, 7, 4),
5 => quad(4, 7, 6, 5),
_ => None,
}
}
}