1 | // |
2 | // Redistribution and use in source and binary forms, with or without |
3 | // modification, are permitted provided that the following conditions |
4 | // are met: |
5 | // * Redistributions of source code must retain the above copyright |
6 | // notice, this list of conditions and the following disclaimer. |
7 | // * Redistributions in binary form must reproduce the above copyright |
8 | // notice, this list of conditions and the following disclaimer in the |
9 | // documentation and/or other materials provided with the distribution. |
10 | // * Neither the name of NVIDIA CORPORATION nor the names of its |
11 | // contributors may be used to endorse or promote products derived |
12 | // from this software without specific prior written permission. |
13 | // |
14 | // THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS ''AS IS'' AND ANY |
15 | // EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE |
16 | // IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR |
17 | // PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR |
18 | // CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, |
19 | // EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, |
20 | // PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR |
21 | // PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY |
22 | // OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT |
23 | // (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE |
24 | // OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. |
25 | // |
26 | // Copyright (c) 2008-2021 NVIDIA Corporation. All rights reserved. |
27 | // Copyright (c) 2004-2008 AGEIA Technologies, Inc. All rights reserved. |
28 | // Copyright (c) 2001-2004 NovodeX AG. All rights reserved. |
29 | |
30 | #ifndef PXFOUNDATION_PXMATHUTILS_H |
31 | #define PXFOUNDATION_PXMATHUTILS_H |
32 | |
33 | /** \addtogroup common |
34 | @{ |
35 | */ |
36 | |
37 | #include "foundation/Px.h" |
38 | #include "foundation/PxFoundationConfig.h" |
39 | #include "foundation/PxPlane.h" |
40 | #include "foundation/PxTransform.h" |
41 | |
42 | #if !PX_DOXYGEN |
43 | namespace physx |
44 | { |
45 | #endif |
46 | |
47 | /** |
48 | \brief finds the shortest rotation between two vectors. |
49 | |
50 | \param[in] from the vector to start from |
51 | \param[in] target the vector to rotate to |
52 | \return a rotation about an axis normal to the two vectors which takes one to the other via the shortest path |
53 | */ |
54 | PX_FOUNDATION_API PxQuat PxShortestRotation(const PxVec3& from, const PxVec3& target); |
55 | |
56 | /* \brief diagonalizes a 3x3 symmetric matrix y |
57 | |
58 | The returned matrix satisfies M = R * D * R', where R is the rotation matrix for the output quaternion, R' its |
59 | transpose, and D the diagonal matrix |
60 | |
61 | If the matrix is not symmetric, the result is undefined. |
62 | |
63 | \param[in] m the matrix to diagonalize |
64 | \param[out] axes a quaternion rotation which diagonalizes the matrix |
65 | \return the vector diagonal of the diagonalized matrix. |
66 | */ |
67 | PX_FOUNDATION_API PxVec3 PxDiagonalize(const PxMat33& m, PxQuat& axes); |
68 | |
69 | /** \brief creates a transform from the endpoints of a segment, suitable for an actor transform for a PxCapsuleGeometry |
70 | |
71 | \param[in] p0 one end of major axis of the capsule |
72 | \param[in] p1 the other end of the axis of the capsule |
73 | \param[out] halfHeight the halfHeight of the capsule. This parameter is optional. |
74 | \return A PxTransform which will transform the vector (1,0,0) to the capsule axis shrunk by the halfHeight |
75 | */ |
76 | PX_FOUNDATION_API PxTransform PxTransformFromSegment(const PxVec3& p0, const PxVec3& p1, PxReal* halfHeight = NULL); |
77 | |
78 | /** \brief creates a transform from a plane equation, suitable for an actor transform for a PxPlaneGeometry |
79 | |
80 | \param[in] plane the desired plane equation |
81 | \return a PxTransform which will transform the plane PxPlane(1,0,0,0) to the specified plane |
82 | */ |
83 | PX_FOUNDATION_API PxTransform PxTransformFromPlaneEquation(const PxPlane& plane); |
84 | |
85 | /** \brief creates a plane equation from a transform, such as the actor transform for a PxPlaneGeometry |
86 | |
87 | \param[in] transform the transform |
88 | \return the plane |
89 | */ |
90 | PX_INLINE PxPlane PxPlaneEquationFromTransform(const PxTransform& transform) |
91 | { |
92 | return transform.transform(plane: PxPlane(1.f,0.f,0.f,0.f)); |
93 | } |
94 | |
95 | |
96 | #if !PX_DOXYGEN |
97 | } // namespace physx |
98 | #endif |
99 | |
100 | /** @} */ |
101 | #endif |
102 | |