| 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 | |
|---|
| 31 | #ifndef DY_SOLVEREXTBODY_H |
|---|
| 32 | #define DY_SOLVEREXTBODY_H |
|---|
| 33 | |
|---|
| 34 | #include "foundation/PxVec3.h" |
|---|
| 35 | #include "foundation/PxTransform.h" |
|---|
| 36 | #include "CmPhysXCommon.h" |
|---|
| 37 | #include "CmSpatialVector.h" |
|---|
| 38 | #include "PsVecMath.h" |
|---|
| 39 | |
|---|
| 40 | namespace physx |
|---|
| 41 | { |
|---|
| 42 | |
|---|
| 43 | class PxsRigidBody; |
|---|
| 44 | struct PxsBodyCore; |
|---|
| 45 | struct PxSolverBody; |
|---|
| 46 | struct PxSolverBodyData; |
|---|
| 47 | |
|---|
| 48 | |
|---|
| 49 | namespace Dy |
|---|
| 50 | { |
|---|
| 51 | |
|---|
| 52 | |
|---|
| 53 | class ArticulationV; |
|---|
| 54 | struct SolverConstraint1D; |
|---|
| 55 | |
|---|
| 56 | class SolverExtBody |
|---|
| 57 | { |
|---|
| 58 | public: |
|---|
| 59 | union |
|---|
| 60 | { |
|---|
| 61 | const ArticulationV* mArticulation; |
|---|
| 62 | const PxSolverBody* mBody; |
|---|
| 63 | }; |
|---|
| 64 | const PxSolverBodyData* mBodyData; |
|---|
| 65 | |
|---|
| 66 | PxU16 mLinkIndex; |
|---|
| 67 | |
|---|
| 68 | SolverExtBody(const void* bodyOrArticulation, const void* bodyData, PxU16 linkIndex): |
|---|
| 69 | mBody(reinterpret_cast<const PxSolverBody*>(bodyOrArticulation)), |
|---|
| 70 | mBodyData(reinterpret_cast<const PxSolverBodyData*>(bodyData)), |
|---|
| 71 | mLinkIndex(linkIndex) |
|---|
| 72 | {} |
|---|
| 73 | |
|---|
| 74 | void getResponse(const PxVec3& linImpulse, const PxVec3& angImpulse, |
|---|
| 75 | PxVec3& linDeltaV, PxVec3& angDeltaV, PxReal dominance) const; |
|---|
| 76 | |
|---|
| 77 | void getResponse(const Ps::aos::Vec3V& linImpulse, const Ps::aos::Vec3V& angImpulse, |
|---|
| 78 | Ps::aos::Vec3V& linDeltaV, Ps::aos::Vec3V& angDeltaV, Ps::aos::FloatV dominance) const; |
|---|
| 79 | |
|---|
| 80 | PxReal projectVelocity(const PxVec3& linear, const PxVec3& angular) const; |
|---|
| 81 | Ps::aos::FloatV projectVelocity(const Ps::aos::Vec3V& linear, const Ps::aos::Vec3V& angular) const; |
|---|
| 82 | PxVec3 getLinVel() const; |
|---|
| 83 | PxVec3 getAngVel() const; |
|---|
| 84 | |
|---|
| 85 | Ps::aos::Vec3V getLinVelV() const; |
|---|
| 86 | Ps::aos::Vec3V getAngVelV() const; |
|---|
| 87 | |
|---|
| 88 | Cm::SpatialVectorV getVelocity() const; |
|---|
| 89 | }; |
|---|
| 90 | |
|---|
| 91 | } |
|---|
| 92 | |
|---|
| 93 | } |
|---|
| 94 | |
|---|
| 95 | #endif //DY_SOLVEREXTBODY_H |
|---|
| 96 | |
|---|
