92         for (
int i=0;i<numBodies;i++)
   108     for (
int i = 0; i < ndof; ++i) 
   126                 for (
int i = 0; i < ndofA; ++i) 
   137                 for (
int i = 0; i < ndofB; ++i) 
   168 #ifdef DIRECTLY_UPDATE_VELOCITY_DURING_SOLVER_ITERATIONS   172 #endif //DIRECTLY_UPDATE_VELOCITY_DURING_SOLVER_ITERATIONS   181 #ifdef DIRECTLY_UPDATE_VELOCITY_DURING_SOLVER_ITERATIONS   185 #endif //DIRECTLY_UPDATE_VELOCITY_DURING_SOLVER_ITERATIONS   203         BT_PROFILE(
"setupMultiBodyContactConstraint");
   231                 if (solverConstraint.
m_linkA<0)
   238                 const int ndofA  = multiBodyA->
getNumDofs() + 6;
   277                 if (solverConstraint.
m_linkB<0)
   285                 const int ndofB  = multiBodyB->
getNumDofs() + 6;
   332                         for (
int i = 0; i < ndofA; ++i)
   348                         const int ndofB  = multiBodyB->
getNumDofs() + 6;
   351                         for (
int i = 0; i < ndofB; ++i)
   399                         for (
int i = 0; i < ndofA ; ++i) 
   412                         for (
int i = 0; i < ndofB ; ++i) 
   478                 btScalar velocityError = restitution - rel_vel;
   483                         erp = infoGlobal.
m_erp;
   489                         velocityError -= penetration / infoGlobal.
m_timeStep;
   493                         positionalError = -penetration * erp/infoGlobal.
m_timeStep;
   504                                 solverConstraint.
m_rhs = penetrationImpulse+velocityImpulse;
   510                                 solverConstraint.
m_rhs = velocityImpulse;
   519                         solverConstraint.
m_rhs = velocityImpulse;
   525                 solverConstraint.
m_cfm = 0.f;                   
   541         bool isFriction = 
true;
   560                 solverConstraint.
m_linkB = fcB->m_link;
   565         return solverConstraint;
   620                                 solverConstraint.
m_linkB = fcB->m_link;
   624                         bool isFriction = 
false;
   631 #define ENABLE_FRICTION   632 #ifdef ENABLE_FRICTION   635         int rollingFriction=1;
   638                                 angVelA = rb0->getAngularVelocity();
   640                                 angVelB = rb1->getAngularVelocity();
   652                                         if (relAngVel.
length()>0.001)
   671 #endif //ROLLING_FRICTION   745 #endif //ENABLE_FRICTION   755         for (
int i=0;i<numManifolds;i++)
   799                 forceVector.
resize(numDofsPlusBase);
   800                 for (
int i=0;i<numDofsPlusBase;i++)
   802                         forceVector[i] = data.
m_jacobians[jacIndex+i]*appliedImpulse;
   805                 output.
resize(numDofsPlusBase);
   806                 bool applyJointFeedback = 
true;
   812 #include "Bullet3Common/b3Logging.h"   867 #ifndef DIRECTLY_UPDATE_VELOCITY_DURING_SOLVER_ITERATIONS   901         BT_PROFILE(
"btMultiBodyConstraintSolver::solveGroupCacheFriendlyFinish");
   907         for (
int i=0;i<numPoolConstraints;i++)
   931                 for (
int j=0;j<numPoolConstraints;j++)
   951                 for (
int j=0;j<numPoolConstraints;j++)
  1022         for (
int i=0;i<numPoolConstraints;i++)
  1051 void  btMultiBodyConstraintSolver::solveMultiBodyGroup(
btCollisionObject** bodies,
int numBodies,
btPersistentManifold** manifold,
int numManifolds,
btTypedConstraint** constraints,
int numConstraints,
btMultiBodyConstraint** multiBodyConstraints, 
int numMultiBodyConstraints, 
const btContactSolverInfo& info, 
btIDebugDraw* debugDrawer,
btDispatcher* dispatcher)
 btScalar getInvMass() const 
static T sum(const btAlignedObjectArray< T > &items)
btScalar m_rhsPenetration
btPersistentManifold is a contact point cache, it stays persistent as long as objects are overlapping...
static btMultiBodyLinkCollider * upcast(btCollisionObject *colObj)
virtual btScalar solveGroupCacheFriendlyFinish(btCollisionObject **bodies, int numBodies, const btContactSolverInfo &infoGlobal)
const btMultibodyLink & getLink(int index) const 
void setupMultiBodyContactConstraint(btMultiBodySolverConstraint &solverConstraint, const btVector3 &contactNormal, btManifoldPoint &cp, const btContactSolverInfo &infoGlobal, btScalar &relaxation, bool isFriction, btScalar desiredVelocity=0, btScalar cfmSlip=0)
btVector3 m_relpos1CrossNormal
1D constraint along a normal axis between bodyA and bodyB. It can be combined to solve contact and fr...
btVector3 m_contactNormal2
btVector3 m_lateralFrictionDir1
btAlignedObjectArray< btScalar > scratch_r
btAlignedObjectArray< btScalar > m_deltaVelocities
virtual void createConstraintRows(btMultiBodyConstraintArray &constraintRows, btMultiBodyJacobianData &data, const btContactSolverInfo &infoGlobal)=0
void internalApplyImpulse(const btVector3 &linearComponent, const btVector3 &angularComponent, const btScalar impulseMagnitude)
btAlignedObjectArray< btSolverBody > * m_solverBodyPool
const btVector3 & getAngularFactor() const 
btScalar m_appliedImpulseLateral1
virtual btScalar solveSingleIteration(int iteration, btCollisionObject **bodies, int numBodies, btPersistentManifold **manifoldPtr, int numManifolds, btTypedConstraint **constraints, int numConstraints, const btContactSolverInfo &infoGlobal, btIDebugDraw *debugDrawer)
virtual btScalar solveGroupCacheFriendlyFinish(btCollisionObject **bodies, int numBodies, const btContactSolverInfo &infoGlobal)
btVector3 m_angularComponentA
void writeBackSolverBodyToMultiBody(btMultiBodySolverConstraint &constraint, btScalar deltaTime)
btVector3 m_angularComponentB
btScalar m_combinedRestitution
virtual btScalar solveGroup(btCollisionObject **bodies, int numBodies, btPersistentManifold **manifold, int numManifolds, btTypedConstraint **constraints, int numConstraints, const btContactSolverInfo &info, btIDebugDraw *debugDrawer, btDispatcher *dispatcher)
btSequentialImpulseConstraintSolver Sequentially applies impulses 
btMultiBodyConstraint * m_orgConstraint
void internalSetAppliedImpulse(int dof, btScalar appliedImpulse)
void btPlaneSpace1(const T &n, T &p, T &q)
btScalar m_appliedImpulse
void addLinkConstraintForce(int i, const btVector3 &f)
btScalar getBreakingImpulseThreshold() const 
virtual btScalar solveSingleIteration(int iteration, btCollisionObject **bodies, int numBodies, btPersistentManifold **manifoldPtr, int numManifolds, btTypedConstraint **constraints, int numConstraints, const btContactSolverInfo &infoGlobal, btIDebugDraw *debugDrawer)
bool internalNeedsJointFeedback() const 
ManifoldContactPoint collects and maintains persistent contactpoints. 
const btCollisionObject * getBody0() const 
btScalar m_contactMotion1
int m_tmpNumMultiBodyConstraints
void applyDeltaVeeMultiDof(const btScalar *delta_vee, btScalar multiplier)
btScalar restitutionCurve(btScalar rel_vel, btScalar restitution)
btAlignedObjectArray< btMatrix3x3 > scratch_m
btScalar dot(const btVector3 &v) const 
Return the dot product. 
btVector3 & normalize()
Normalize this vector x^2 + y^2 + z^2 = 1. 
virtual btScalar solveGroup(btCollisionObject **bodies, int numBodies, btPersistentManifold **manifold, int numManifolds, btTypedConstraint **constraints, int numConstraints, const btContactSolverInfo &info, btIDebugDraw *debugDrawer, btDispatcher *dispatcher)
this method should not be called, it was just used during porting/integration of Featherstone btMulti...
btVector3 getVelocityInLocalPoint(const btVector3 &rel_pos) const 
const btJointFeedback * getJointFeedback() const 
btMultiBodyConstraintArray m_multiBodyNonContactConstraints
int getOrInitSolverBody(btCollisionObject &body, btScalar timeStep)
btAlignedObjectArray< btScalar > m_deltaVelocitiesUnitImpulse
void addLinkConstraintTorque(int i, const btVector3 &t)
#define btSimdScalar
Until we get other contributions, only use SIMD on Windows, when using Visual Studio 2008 or later...
btScalar m_combinedRollingFriction
btAlignedObjectArray< btSolverBody > m_tmpSolverBodyPool
void resolveSingleConstraintRowGeneric(const btMultiBodySolverConstraint &c)
btVector3 m_normalWorldOnB
int size() const 
return the number of elements in the array 
virtual void solveMultiBodyGroup(btCollisionObject **bodies, int numBodies, btPersistentManifold **manifold, int numManifolds, btTypedConstraint **constraints, int numConstraints, btMultiBodyConstraint **multiBodyConstraints, int numMultiBodyConstraints, const btContactSolverInfo &info, btIDebugDraw *debugDrawer, btDispatcher *dispatcher)
btVector3 m_appliedForceBodyA
btMultiBody * m_multiBodyA
void setCompanionId(int id)
btScalar m_appliedImpulseLateral2
btVector3 cross(const btVector3 &v) const 
Return the cross product between this and another vector. 
void convertContacts(btPersistentManifold **manifoldPtr, int numManifolds, const btContactSolverInfo &infoGlobal)
btCollisionObject can be used to manage collision detection objects. 
btScalar getContactProcessingThreshold() const 
The btIDebugDraw interface class allows hooking up a debug renderer to visually debug simulations...
btMultiBody * m_multiBodyB
The btRigidBody is the main class for rigid body objects. 
btScalar length() const 
Return the length of the vector. 
const btManifoldPoint & getContactPoint(int index) const 
btMultiBodyConstraintArray m_multiBodyFrictionContactConstraints
btAlignedObjectArray< btScalar > m_jacobians
const btVector3 & internalGetInvMass() const 
void * m_originalContactPoint
const btVector3 & getPositionWorldOnB() const 
btVector3 can be used to represent 3D points and vectors. 
void convertContact(btPersistentManifold *manifold, const btContactSolverInfo &infoGlobal)
btAlignedObjectArray< btVector3 > scratch_v
btSimdScalar m_appliedImpulse
void calcAccelerationDeltasMultiDof(const btScalar *force, btScalar *output, btAlignedObjectArray< btScalar > &scratch_r, btAlignedObjectArray< btVector3 > &scratch_v) const 
btMultiBodySolverConstraint & addMultiBodyFrictionConstraint(const btVector3 &normalAxis, btPersistentManifold *manifold, int frictionIndex, btManifoldPoint &cp, btCollisionObject *colObj0, btCollisionObject *colObj1, btScalar relaxation, const btContactSolverInfo &infoGlobal, btScalar desiredVelocity=0, btScalar cfmSlip=0)
btSolverConstraint & addRollingFrictionConstraint(const btVector3 &normalAxis, int solverBodyIdA, int solverBodyIdB, int frictionIndex, btManifoldPoint &cp, const btVector3 &rel_pos1, const btVector3 &rel_pos2, btCollisionObject *colObj0, btCollisionObject *colObj1, btScalar relaxation, btScalar desiredVelocity=0, btScalar cfmSlip=0.f)
The btSolverBody is an internal datastructure for the constraint solver. Only necessary data is packe...
int getCompanionId() const 
void fillContactJacobianMultiDof(int link, const btVector3 &contact_point, const btVector3 &normal, btScalar *jac, btAlignedObjectArray< btScalar > &scratch_r, btAlignedObjectArray< btVector3 > &scratch_v, btAlignedObjectArray< btMatrix3x3 > &scratch_m) const 
TypedConstraint is the baseclass for Bullet constraints and vehicles. 
void resize(int newsize, const T &fillData=T())
btRigidBody * m_originalBody
int getNumContacts() const 
btVector3 & internalGetDeltaLinearVelocity()
some internal methods, don't use them 
const btRigidBody & getRigidBodyA() const 
void setEnabled(bool enabled)
void convertMultiBodyContact(btPersistentManifold *manifold, const btContactSolverInfo &infoGlobal)
void applyDeltaVeeMultiDof2(const btScalar *delta_vee, btScalar multiplier)
virtual btScalar solveGroupCacheFriendlySetup(btCollisionObject **bodies, int numBodies, btPersistentManifold **manifoldPtr, int numManifolds, btTypedConstraint **constraints, int numConstraints, const btContactSolverInfo &infoGlobal, btIDebugDraw *debugDrawer)
virtual btScalar solveGroupCacheFriendlySetup(btCollisionObject **bodies, int numBodies, btPersistentManifold **manifoldPtr, int numManifolds, btTypedConstraint **constraints, int numConstraints, const btContactSolverInfo &infoGlobal, btIDebugDraw *debugDrawer)
void setPosUpdated(bool updated)
void applyDeltaVee(btScalar *deltaV, btScalar impulse, int velocityIndex, int ndof)
btMultiBodyConstraintArray m_multiBodyNormalContactConstraints
btScalar m_contactMotion2
const btMatrix3x3 & getInvInertiaTensorWorld() const 
btScalar m_combinedFriction
bool m_lateralFrictionInitialized
btMultiBodyConstraint ** m_tmpMultiBodyConstraints
const btVector3 & getPositionWorldOnA() const 
btVector3 m_relpos2CrossNormal
btTransform m_cachedWorldTransform
const btTransform & getWorldTransform() const 
btVector3 & internalGetDeltaAngularVelocity()
void internalSetAppliedImpulse(btScalar appliedImpulse)
internal method used by the constraint solver, don't use them directly 
void addBaseConstraintForce(const btVector3 &f)
btVector3 m_lateralFrictionDir2
btMultiBody * m_multiBody
btSimdScalar m_appliedPushImpulse
btScalar getDistance() const 
const btVector3 & getBasePos() const 
The btDispatcher interface class can be used in combination with broadphase to dispatch calculations ...
const btVector3 & getLinearFactor() const 
T & expandNonInitializing()
btVector3 m_contactNormal1
void addBaseConstraintTorque(const btVector3 &t)
const btRigidBody & getRigidBodyB() const 
static void applyAnisotropicFriction(btCollisionObject *colObj, btVector3 &frictionDirection, int frictionMode)
const btCollisionObject * getBody1() const 
const btScalar * getVelocityVector() const 
float btScalar
The btScalar type abstracts floating point numbers, to easily switch between double and single floati...
btMultiBodyJacobianData m_data
btScalar btFabs(btScalar x)