| 1 | /* | 
|---|
| 2 | * Copyright (c) 2006-2011 Erin Catto http://www.box2d.org | 
|---|
| 3 | * | 
|---|
| 4 | * This software is provided 'as-is', without any express or implied | 
|---|
| 5 | * warranty.  In no event will the authors be held liable for any damages | 
|---|
| 6 | * arising from the use of this software. | 
|---|
| 7 | * Permission is granted to anyone to use this software for any purpose, | 
|---|
| 8 | * including commercial applications, and to alter it and redistribute it | 
|---|
| 9 | * freely, subject to the following restrictions: | 
|---|
| 10 | * 1. The origin of this software must not be misrepresented; you must not | 
|---|
| 11 | * claim that you wrote the original software. If you use this software | 
|---|
| 12 | * in a product, an acknowledgment in the product documentation would be | 
|---|
| 13 | * appreciated but is not required. | 
|---|
| 14 | * 2. Altered source versions must be plainly marked as such, and must not be | 
|---|
| 15 | * misrepresented as being the original software. | 
|---|
| 16 | * 3. This notice may not be removed or altered from any source distribution. | 
|---|
| 17 | */ | 
|---|
| 18 |  | 
|---|
| 19 | #ifndef B2_ROPE_JOINT_H | 
|---|
| 20 | #define B2_ROPE_JOINT_H | 
|---|
| 21 |  | 
|---|
| 22 | #include <Box2D/Dynamics/Joints/b2Joint.h> | 
|---|
| 23 |  | 
|---|
| 24 | /// Rope joint definition. This requires two body anchor points and | 
|---|
| 25 | /// a maximum lengths. | 
|---|
| 26 | /// Note: by default the connected objects will not collide. | 
|---|
| 27 | /// see collideConnected in b2JointDef. | 
|---|
| 28 | struct b2RopeJointDef : public b2JointDef | 
|---|
| 29 | { | 
|---|
| 30 | b2RopeJointDef() | 
|---|
| 31 | { | 
|---|
| 32 | type = e_ropeJoint; | 
|---|
| 33 | localAnchorA.Set(-1.0f, 0.0f); | 
|---|
| 34 | localAnchorB.Set(1.0f, 0.0f); | 
|---|
| 35 | maxLength = 0.0f; | 
|---|
| 36 | } | 
|---|
| 37 |  | 
|---|
| 38 | /// The local anchor point relative to bodyA's origin. | 
|---|
| 39 | b2Vec2 localAnchorA; | 
|---|
| 40 |  | 
|---|
| 41 | /// The local anchor point relative to bodyB's origin. | 
|---|
| 42 | b2Vec2 localAnchorB; | 
|---|
| 43 |  | 
|---|
| 44 | /// The maximum length of the rope. | 
|---|
| 45 | /// Warning: this must be larger than b2_linearSlop or | 
|---|
| 46 | /// the joint will have no effect. | 
|---|
| 47 | float32 maxLength; | 
|---|
| 48 | }; | 
|---|
| 49 |  | 
|---|
| 50 | /// A rope joint enforces a maximum distance between two points | 
|---|
| 51 | /// on two bodies. It has no other effect. | 
|---|
| 52 | /// Warning: if you attempt to change the maximum length during | 
|---|
| 53 | /// the simulation you will get some non-physical behavior. | 
|---|
| 54 | /// A model that would allow you to dynamically modify the length | 
|---|
| 55 | /// would have some sponginess, so I chose not to implement it | 
|---|
| 56 | /// that way. See b2DistanceJoint if you want to dynamically | 
|---|
| 57 | /// control length. | 
|---|
| 58 | class b2RopeJoint : public b2Joint | 
|---|
| 59 | { | 
|---|
| 60 | public: | 
|---|
| 61 | b2Vec2 GetAnchorA() const; | 
|---|
| 62 | b2Vec2 GetAnchorB() const; | 
|---|
| 63 |  | 
|---|
| 64 | b2Vec2 GetReactionForce(float32 inv_dt) const; | 
|---|
| 65 | float32 GetReactionTorque(float32 inv_dt) const; | 
|---|
| 66 |  | 
|---|
| 67 | /// The local anchor point relative to bodyA's origin. | 
|---|
| 68 | const b2Vec2& GetLocalAnchorA() const { return m_localAnchorA; } | 
|---|
| 69 |  | 
|---|
| 70 | /// The local anchor point relative to bodyB's origin. | 
|---|
| 71 | const b2Vec2& GetLocalAnchorB() const  { return m_localAnchorB; } | 
|---|
| 72 |  | 
|---|
| 73 | /// Set/Get the maximum length of the rope. | 
|---|
| 74 | void SetMaxLength(float32 length) { m_maxLength = length; } | 
|---|
| 75 | float32 GetMaxLength() const; | 
|---|
| 76 |  | 
|---|
| 77 | b2LimitState GetLimitState() const; | 
|---|
| 78 |  | 
|---|
| 79 | /// Dump joint to dmLog | 
|---|
| 80 | void Dump(); | 
|---|
| 81 |  | 
|---|
| 82 | protected: | 
|---|
| 83 |  | 
|---|
| 84 | friend class b2Joint; | 
|---|
| 85 | b2RopeJoint(const b2RopeJointDef* data); | 
|---|
| 86 |  | 
|---|
| 87 | void InitVelocityConstraints(const b2SolverData& data); | 
|---|
| 88 | void SolveVelocityConstraints(const b2SolverData& data); | 
|---|
| 89 | bool SolvePositionConstraints(const b2SolverData& data); | 
|---|
| 90 |  | 
|---|
| 91 | // Solver shared | 
|---|
| 92 | b2Vec2 m_localAnchorA; | 
|---|
| 93 | b2Vec2 m_localAnchorB; | 
|---|
| 94 | float32 m_maxLength; | 
|---|
| 95 | float32 m_length; | 
|---|
| 96 | float32 m_impulse; | 
|---|
| 97 |  | 
|---|
| 98 | // Solver temp | 
|---|
| 99 | int32 m_indexA; | 
|---|
| 100 | int32 m_indexB; | 
|---|
| 101 | b2Vec2 m_u; | 
|---|
| 102 | b2Vec2 m_rA; | 
|---|
| 103 | b2Vec2 m_rB; | 
|---|
| 104 | b2Vec2 m_localCenterA; | 
|---|
| 105 | b2Vec2 m_localCenterB; | 
|---|
| 106 | float32 m_invMassA; | 
|---|
| 107 | float32 m_invMassB; | 
|---|
| 108 | float32 m_invIA; | 
|---|
| 109 | float32 m_invIB; | 
|---|
| 110 | float32 m_mass; | 
|---|
| 111 | b2LimitState m_state; | 
|---|
| 112 | }; | 
|---|
| 113 |  | 
|---|
| 114 | #endif | 
|---|
| 115 |  | 
|---|