00001 /* 00002 * Copyright (c) 2006-2007 Erin Catto http://www.box2d.org 00003 * 00004 * This software is provided 'as-is', without any express or implied 00005 * warranty. In no event will the authors be held liable for any damages 00006 * arising from the use of this software. 00007 * Permission is granted to anyone to use this software for any purpose, 00008 * including commercial applications, and to alter it and redistribute it 00009 * freely, subject to the following restrictions: 00010 * 1. The origin of this software must not be misrepresented; you must not 00011 * claim that you wrote the original software. If you use this software 00012 * in a product, an acknowledgment in the product documentation would be 00013 * appreciated but is not required. 00014 * 2. Altered source versions must be plainly marked as such, and must not be 00015 * misrepresented as being the original software. 00016 * 3. This notice may not be removed or altered from any source distribution. 00017 */ 00018 00019 #ifndef B2_FRICTION_JOINT_H 00020 #define B2_FRICTION_JOINT_H 00021 00022 #include <Box2D/Dynamics/Joints/b2Joint.h> 00023 00025 struct b2FrictionJointDef : public b2JointDef 00026 { 00027 b2FrictionJointDef() 00028 { 00029 type = e_frictionJoint; 00030 localAnchorA.SetZero(); 00031 localAnchorB.SetZero(); 00032 maxForce = 0.0f; 00033 maxTorque = 0.0f; 00034 } 00035 00038 void Initialize(b2Body* bodyA, b2Body* bodyB, const b2Vec2& anchor); 00039 00041 b2Vec2 localAnchorA; 00042 00044 b2Vec2 localAnchorB; 00045 00047 float32 maxForce; 00048 00050 float32 maxTorque; 00051 }; 00052 00055 class b2FrictionJoint : public b2Joint 00056 { 00057 public: 00058 b2Vec2 GetAnchorA() const; 00059 b2Vec2 GetAnchorB() const; 00060 00061 b2Vec2 GetReactionForce(float32 inv_dt) const; 00062 float32 GetReactionTorque(float32 inv_dt) const; 00063 00065 const b2Vec2& GetLocalAnchorA() const { return m_localAnchorA; } 00066 00068 const b2Vec2& GetLocalAnchorB() const { return m_localAnchorB; } 00069 00071 void SetMaxForce(float32 force); 00072 00074 float32 GetMaxForce() const; 00075 00077 void SetMaxTorque(float32 torque); 00078 00080 float32 GetMaxTorque() const; 00081 00083 void Dump(); 00084 00085 protected: 00086 00087 friend class b2Joint; 00088 00089 b2FrictionJoint(const b2FrictionJointDef* def); 00090 00091 void InitVelocityConstraints(const b2SolverData& data); 00092 void SolveVelocityConstraints(const b2SolverData& data); 00093 bool SolvePositionConstraints(const b2SolverData& data); 00094 00095 b2Vec2 m_localAnchorA; 00096 b2Vec2 m_localAnchorB; 00097 00098 // Solver shared 00099 b2Vec2 m_linearImpulse; 00100 float32 m_angularImpulse; 00101 float32 m_maxForce; 00102 float32 m_maxTorque; 00103 00104 // Solver temp 00105 int32 m_indexA; 00106 int32 m_indexB; 00107 b2Vec2 m_rA; 00108 b2Vec2 m_rB; 00109 b2Vec2 m_localCenterA; 00110 b2Vec2 m_localCenterB; 00111 float32 m_invMassA; 00112 float32 m_invMassB; 00113 float32 m_invIA; 00114 float32 m_invIB; 00115 b2Mat22 m_linearMass; 00116 float32 m_angularMass; 00117 }; 00118 00119 #endif