parry3d 0.28.0

3 dimensional collision detection library in Rust.
Documentation 
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
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154

//! Vector extension trait for glam types.

use crate::math::{IVector, Int, Matrix, Real, Vector};

#[cfg(not(feature = "std"))]
use simba::scalar::ComplexField;

/// Extension trait for glam vector types to provide additional functionality.
pub trait VectorExt: Sized + Copy {
    /// Creates a vector with the i-th component set to `val` and all others to zero.
    fn ith(i: usize, val: Real) -> Self;

    /// Computes the angle between two vectors in radians.
    fn angle(self, other: Self) -> Real;

    /// Computes the kronecker product between two vectors.
    fn kronecker(self, other: Self) -> Matrix;

    /// Gets the i-th component of the vector by index.
    ///
    /// This is a SPIR-V compatible replacement for bracket indexing (`v[i]`),
    /// which is not supported on glam types when targeting SPIR-V.
    fn vget(&self, i: usize) -> Real;

    /// Sets the i-th component of the vector by index.
    ///
    /// This is a SPIR-V compatible replacement for bracket indexing (`v[i] = val`),
    /// which is not supported on glam types when targeting SPIR-V.
    fn vset(&mut self, i: usize, val: Real);
}

impl VectorExt for Vector {
    #[inline]
    #[cfg(feature = "dim2")]
    fn ith(i: usize, val: Real) -> Self {
        match i {
            0 => Self::new(val, 0.0),
            1 => Self::new(0.0, val),
            _ => Self::ZERO,
        }
    }

    #[inline]
    #[cfg(feature = "dim3")]
    fn ith(i: usize, val: Real) -> Self {
        match i {
            0 => Self::new(val, 0.0, 0.0),
            1 => Self::new(0.0, val, 0.0),
            2 => Self::new(0.0, 0.0, val),
            _ => Self::ZERO,
        }
    }

    #[inline]
    fn angle(self, other: Self) -> Real {
        let dot = self.dot(other);
        let len_self = self.length();
        let len_other = other.length();
        if len_self > 0.0 && len_other > 0.0 {
            (dot / (len_self * len_other)).clamp(-1.0, 1.0).acos()
        } else {
            0.0
        }
    }

    #[inline]
    #[cfg(feature = "dim2")]
    fn kronecker(self, other: Self) -> Matrix {
        Matrix::from_cols(self * other.x, self * other.y)
    }

    #[inline]
    #[cfg(feature = "dim3")]
    fn kronecker(self, other: Self) -> Matrix {
        Matrix::from_cols(self * other.x, self * other.y, self * other.z)
    }

    #[inline]
    fn vget(&self, i: usize) -> Real {
        #[cfg(target_arch = "spirv")]
        return match i {
            0 => self.x,
            1 => self.y,
            #[cfg(feature = "dim3")]
            2 => self.z,
            _ => panic!("Index out of bounds for 2D vector: {i}"),
        };
        #[cfg(not(target_arch = "spirv"))]
        {
            self[i]
        }
    }

    #[inline]
    fn vset(&mut self, i: usize, val: Real) {
        #[cfg(target_arch = "spirv")]
        match i {
            0 => self.x = val,
            1 => self.y = val,
            #[cfg(feature = "dim3")]
            2 => self.z = val,
            _ => panic!("Index out of bounds for 2D vector: {i}"),
        };
        #[cfg(not(target_arch = "spirv"))]
        {
            self[i] = val;
        }
    }
}

/// Extension trait for integer vector types with index-based component access.
///
/// Provides SPIR-V compatible replacement for bracket indexing on glam integer vectors.
pub trait IVectorExt: Sized + Copy {
    /// Gets the i-th component of the integer vector by index.
    fn ivget(&self, i: usize) -> Int;

    /// Sets the i-th component of the integer vector by index.
    fn ivset(&mut self, i: usize, val: Int);
}

impl IVectorExt for IVector {
    #[inline]
    fn ivget(&self, i: usize) -> Int {
        #[cfg(target_arch = "spirv")]
        return match i {
            0 => self.x,
            1 => self.y,
            #[cfg(feature = "dim3")]
            2 => self.z,
            _ => panic!("Index out of bounds for 2D integer vector: {i}"),
        };
        #[cfg(not(target_arch = "spirv"))]
        {
            self[i]
        }
    }

    #[inline]
    fn ivset(&mut self, i: usize, val: Int) {
        #[cfg(target_arch = "spirv")]
        match i {
            0 => self.x = val,
            1 => self.y = val,
            #[cfg(feature = "dim3")]
            2 => self.z = val,
            _ => panic!("Index out of bounds for 2D integer vector: {i}"),
        }
        #[cfg(not(target_arch = "spirv"))]
        {
            self[i] = val;
        }
    }
}