| 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 | |