102#include <emmintrin.h>
104#define btVecSplat(x, e) _mm_shuffle_ps(x, x, _MM_SHUFFLE(e, e, e, e))
105static inline __m128 btSimdDot3(__m128 vec0, __m128 vec1)
107 __m128 result = _mm_mul_ps(vec0, vec1);
108 return _mm_add_ps(btVecSplat(result, 0), _mm_add_ps(btVecSplat(result, 1), btVecSplat(result, 2)));
111#if defined(BT_ALLOW_SSE4)
115#define USE_FMA3_INSTEAD_FMA4 1
116#define USE_SSE4_DOT 1
118#define SSE4_DP(a, b) _mm_dp_ps(a, b, 0x7f)
119#define SSE4_DP_FP(a, b) _mm_cvtss_f32(_mm_dp_ps(a, b, 0x7f))
122#define DOT_PRODUCT(a, b) SSE4_DP(a, b)
124#define DOT_PRODUCT(a, b) btSimdDot3(a, b)
128#if USE_FMA3_INSTEAD_FMA4
130#define FMADD(a, b, c) _mm_fmadd_ps(a, b, c)
132#define FMNADD(a, b, c) _mm_fnmadd_ps(a, b, c)
135#define FMADD(a, b, c) _mm_macc_ps(a, b, c)
137#define FMNADD(a, b, c) _mm_nmacc_ps(a, b, c)
141#define FMADD(a, b, c) _mm_add_ps(c, _mm_mul_ps(a, b))
143#define FMNADD(a, b, c) _mm_sub_ps(c, _mm_mul_ps(a, b))
156 deltaImpulse = _mm_sub_ps(deltaImpulse, _mm_mul_ps(deltaVel1Dotn, _mm_set1_ps(c.
m_jacDiagABInv)));
157 deltaImpulse = _mm_sub_ps(deltaImpulse, _mm_mul_ps(deltaVel2Dotn, _mm_set1_ps(c.
m_jacDiagABInv)));
160 resultLowerLess = _mm_cmplt_ps(
sum, lowerLimit1);
161 resultUpperLess = _mm_cmplt_ps(
sum, upperLimit1);
162 __m128 lowMinApplied = _mm_sub_ps(lowerLimit1, cpAppliedImp);
163 deltaImpulse = _mm_or_ps(_mm_and_ps(resultLowerLess, lowMinApplied), _mm_andnot_ps(resultLowerLess, deltaImpulse));
164 c.
m_appliedImpulse = _mm_or_ps(_mm_and_ps(resultLowerLess, lowerLimit1), _mm_andnot_ps(resultLowerLess,
sum));
165 __m128 upperMinApplied = _mm_sub_ps(upperLimit1, cpAppliedImp);
166 deltaImpulse = _mm_or_ps(_mm_and_ps(resultUpperLess, deltaImpulse), _mm_andnot_ps(resultUpperLess, upperMinApplied));
170 __m128 impulseMagnitude = deltaImpulse;
181#if defined(BT_ALLOW_SSE4)
188 deltaImpulse = FMNADD(deltaVel1Dotn, tmp, deltaImpulse);
189 deltaImpulse = FMNADD(deltaVel2Dotn, tmp, deltaImpulse);
191 const __m128 maskLower = _mm_cmpgt_ps(tmp, lowerLimit);
192 const __m128 maskUpper = _mm_cmpgt_ps(upperLimit, tmp);
193 deltaImpulse = _mm_blendv_ps(_mm_sub_ps(lowerLimit, c.
m_appliedImpulse), _mm_blendv_ps(_mm_sub_ps(upperLimit, c.
m_appliedImpulse), deltaImpulse, maskUpper), maskLower);
194 c.
m_appliedImpulse = _mm_blendv_ps(lowerLimit, _mm_blendv_ps(upperLimit, tmp, maskUpper), maskLower);
202 return gResolveSingleConstraintRowGeneric_sse2(bodyA, bodyB, c);
214 deltaImpulse = _mm_sub_ps(deltaImpulse, _mm_mul_ps(deltaVel1Dotn, _mm_set1_ps(c.
m_jacDiagABInv)));
215 deltaImpulse = _mm_sub_ps(deltaImpulse, _mm_mul_ps(deltaVel2Dotn, _mm_set1_ps(c.
m_jacDiagABInv)));
218 resultLowerLess = _mm_cmplt_ps(
sum, lowerLimit1);
219 resultUpperLess = _mm_cmplt_ps(
sum, upperLimit1);
220 __m128 lowMinApplied = _mm_sub_ps(lowerLimit1, cpAppliedImp);
221 deltaImpulse = _mm_or_ps(_mm_and_ps(resultLowerLess, lowMinApplied), _mm_andnot_ps(resultLowerLess, deltaImpulse));
222 c.
m_appliedImpulse = _mm_or_ps(_mm_and_ps(resultLowerLess, lowerLimit1), _mm_andnot_ps(resultLowerLess,
sum));
225 __m128 impulseMagnitude = deltaImpulse;
242 deltaImpulse = FMNADD(deltaVel1Dotn, tmp, deltaImpulse);
243 deltaImpulse = FMNADD(deltaVel2Dotn, tmp, deltaImpulse);
245 const __m128 mask = _mm_cmpgt_ps(tmp, lowerLimit);
246 deltaImpulse = _mm_blendv_ps(_mm_sub_ps(lowerLimit, c.
m_appliedImpulse), deltaImpulse, mask);
255 return gResolveSingleConstraintRowLowerLimit_sse2(bodyA, bodyB, c);
328 deltaImpulse = _mm_sub_ps(deltaImpulse, _mm_mul_ps(deltaVel1Dotn, _mm_set1_ps(c.
m_jacDiagABInv)));
329 deltaImpulse = _mm_sub_ps(deltaImpulse, _mm_mul_ps(deltaVel2Dotn, _mm_set1_ps(c.
m_jacDiagABInv)));
332 resultLowerLess = _mm_cmplt_ps(
sum, lowerLimit1);
333 resultUpperLess = _mm_cmplt_ps(
sum, upperLimit1);
334 __m128 lowMinApplied = _mm_sub_ps(lowerLimit1, cpAppliedImp);
335 deltaImpulse = _mm_or_ps(_mm_and_ps(resultLowerLess, lowMinApplied), _mm_andnot_ps(resultLowerLess, deltaImpulse));
336 c.
m_appliedPushImpulse = _mm_or_ps(_mm_and_ps(resultLowerLess, lowerLimit1), _mm_andnot_ps(resultLowerLess,
sum));
339 __m128 impulseMagnitude = deltaImpulse;
400 return gResolveSingleConstraintRowGeneric_sse2;
404 return gResolveSingleConstraintRowLowerLimit_sse2;
409 return gResolveSingleConstraintRowGeneric_sse4_1_fma3;
413 return gResolveSingleConstraintRowLowerLimit_sse4_1_fma3;
428 const unsigned long un =
static_cast<unsigned long>(n);
433 if (un <= 0x00010000UL)
436 if (un <= 0x00000100UL)
439 if (un <= 0x00000010UL)
442 if (un <= 0x00000004UL)
445 if (un <= 0x00000002UL)
454 return (
int)(r % un);
495 if (
btFabs(rel_vel) < velocityThreshold)
498 btScalar rest = restitution * -rel_vel;
510 loc_lateral *= friction_scaling;
516void btSequentialImpulseConstraintSolver::setupFrictionConstraint(
btSolverConstraint& solverConstraint,
const btVector3& normalAxis,
int solverBodyIdA,
int solverBodyIdB,
btManifoldPoint& cp,
const btVector3& rel_pos1,
const btVector3& rel_pos2,
btCollisionObject* colObj0,
btCollisionObject* colObj1,
btScalar relaxation,
const btContactSolverInfo& infoGlobal,
btScalar desiredVelocity,
btScalar cfmSlip)
575 btScalar denom = relaxation / (denom0 + denom1);
584 rel_vel = vel1Dotn + vel2Dotn;
588 btScalar velocityError = desiredVelocity - rel_vel;
597 penetrationImpulse = positionalError * solverConstraint.
m_jacDiagABInv;
600 solverConstraint.
m_rhs = penetrationImpulse + velocityImpulse;
602 solverConstraint.
m_cfm = cfmSlip;
608btSolverConstraint&
btSequentialImpulseConstraintSolver::addFrictionConstraint(
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,
const btContactSolverInfo& infoGlobal,
btScalar desiredVelocity,
btScalar cfmSlip)
613 colObj0, colObj1, relaxation, infoGlobal, desiredVelocity, cfmSlip);
614 return solverConstraint;
636 solverConstraint.
m_friction = combinedTorsionalFriction;
667 rel_vel = vel1Dotn + vel2Dotn;
673 solverConstraint.
m_rhs = velocityImpulse;
674 solverConstraint.
m_cfm = cfmSlip;
680btSolverConstraint&
btSequentialImpulseConstraintSolver::addTorsionalFrictionConstraint(
const btVector3& normalAxis,
int solverBodyIdA,
int solverBodyIdB,
int frictionIndex,
btManifoldPoint& cp,
btScalar combinedTorsionalFriction,
const btVector3& rel_pos1,
const btVector3& rel_pos2,
btCollisionObject* colObj0,
btCollisionObject* colObj1,
btScalar relaxation,
btScalar desiredVelocity,
btScalar cfmSlip)
685 colObj0, colObj1, relaxation, desiredVelocity, cfmSlip);
686 return solverConstraint;
692 int solverBodyId = -1;
699 if (solverBodyId < 0)
717 const int INVALID_SOLVER_BODY_ID = -1;
724 if (solverBodyId == INVALID_SOLVER_BODY_ID)
737 if (!isMultiBodyType)
755 int solverBodyIdA = -1;
787 return solverBodyIdA;
793 int solverBodyIdA,
int solverBodyIdB,
812 relaxation = infoGlobal.
m_sor;
850#ifdef COMPUTE_IMPULSE_DENOM
869 btScalar denom = relaxation / (denom0 + denom1 + cfm);
940 btScalar rel_vel = vel1Dotn + vel2Dotn;
943 btScalar velocityError = restitution - rel_vel;
949 velocityError -= penetration * invTimeStep;
953 positionalError = -penetration * erp * invTimeStep;
962 solverConstraint.
m_rhs = penetrationImpulse + velocityImpulse;
968 solverConstraint.
m_rhs = velocityImpulse;
978 int solverBodyIdA,
int solverBodyIdB,
1015 int rollingFriction = 1;
1037 rel_pos2 = pos2 - colObj1->getWorldTransform().getOrigin();
1048 setupContactConstraint(solverConstraint, solverBodyIdA, solverBodyIdB, cp, infoGlobal, relaxation, rel_pos1, rel_pos2);
1057 addTorsionalFrictionConstraint(cp.
m_normalWorldOnB, solverBodyIdA, solverBodyIdB, frictionIndex, cp, cp.
m_combinedSpinningFriction, rel_pos1, rel_pos2, colObj0, colObj1, relaxation);
1067 if (axis0.
length() > 0.001)
1070 if (axis1.
length() > 0.001)
1101 addFrictionConstraint(cp.
m_lateralFrictionDir1, solverBodyIdA, solverBodyIdB, frictionIndex, cp, rel_pos1, rel_pos2, colObj0, colObj1, relaxation, infoGlobal);
1109 addFrictionConstraint(cp.
m_lateralFrictionDir2, solverBodyIdA, solverBodyIdB, frictionIndex, cp, rel_pos1, rel_pos2, colObj0, colObj1, relaxation, infoGlobal);
1118 addFrictionConstraint(cp.
m_lateralFrictionDir1, solverBodyIdA, solverBodyIdB, frictionIndex, cp, rel_pos1, rel_pos2, colObj0, colObj1, relaxation, infoGlobal);
1124 addFrictionConstraint(cp.
m_lateralFrictionDir2, solverBodyIdA, solverBodyIdB, frictionIndex, cp, rel_pos1, rel_pos2, colObj0, colObj1, relaxation, infoGlobal);
1135 addFrictionConstraint(cp.
m_lateralFrictionDir1, solverBodyIdA, solverBodyIdB, frictionIndex, cp, rel_pos1, rel_pos2, colObj0, colObj1, relaxation, infoGlobal, cp.
m_contactMotion1, cp.
m_frictionCFM);
1138 addFrictionConstraint(cp.
m_lateralFrictionDir2, solverBodyIdA, solverBodyIdB, frictionIndex, cp, rel_pos1, rel_pos2, colObj0, colObj1, relaxation, infoGlobal, cp.
m_contactMotion2, cp.
m_frictionCFM);
1151 for (i = 0; i < numManifolds; i++)
1153 manifold = manifoldPtr[i];
1218 info2.
cfm = ¤tConstraintRow->
m_cfm;
1278 rel_vel = vel1Dotn + vel2Dotn;
1284 solverConstraint.
m_rhs = penetrationImpulse + velocityImpulse;
1293 for (
int j = 0; j < numConstraints; j++)
1300 int totalNumRows = 0;
1304 for (
int i = 0; i < numConstraints; i++)
1316 if (constraints[i]->isEnabled())
1332 for (
int i = 0; i < numConstraints; i++)
1338 btAssert(currentRow < totalNumRows);
1348 convertJoint(currentConstraintRow, constraint, info1, solverBodyIdA, solverBodyIdB, infoGlobal);
1357 for (
int i = 0; i < numBodies; i++)
1371 for (
int i = 0; i < numBodies; i++)
1415#ifdef BT_ADDITIONAL_DEBUG
1417 for (
int i = 0; i < numConstraints; i++)
1425 for (
int b = 0; b < numBodies; b++)
1438 for (
int b = 0; b < numBodies; b++)
1451 for (
int i = 0; i < numManifolds; i++)
1453 if (!manifoldPtr[i]->getBody0()->isStaticOrKinematicObject())
1456 for (
int b = 0; b < numBodies; b++)
1458 if (manifoldPtr[i]->getBody0() == bodies[b])
1466 if (!manifoldPtr[i]->getBody1()->isStaticOrKinematicObject())
1469 for (
int b = 0; b < numBodies; b++)
1471 if (manifoldPtr[i]->getBody1() == bodies[b])
1505 for (i = 0; i < numNonContactPool; i++)
1509 for (i = 0; i < numConstraintPool; i++)
1513 for (i = 0; i < numFrictionPool; i++)
1525 btScalar leastSquaresResidual = 0.f;
1535 for (
int j = 0; j < numNonContactPool; ++j)
1546 for (
int j = 0; j < numConstraintPool; ++j)
1554 for (
int j = 0; j < numFrictionPool; ++j)
1572 leastSquaresResidual =
btMax(leastSquaresResidual, residual * residual);
1578 for (
int j = 0; j < numConstraints; j++)
1580 if (constraints[j]->isEnabled())
1596 for (
int c = 0; c < numPoolConstraints; c++)
1603 leastSquaresResidual =
btMax(leastSquaresResidual, residual * residual);
1607 bool applyFriction =
true;
1619 leastSquaresResidual =
btMax(leastSquaresResidual, residual * residual);
1633 leastSquaresResidual =
btMax(leastSquaresResidual, residual * residual);
1645 for (j = 0; j < numPoolConstraints; j++)
1649 leastSquaresResidual =
btMax(leastSquaresResidual, residual * residual);
1655 for (j = 0; j < numFrictionPoolConstraints; j++)
1666 leastSquaresResidual =
btMax(leastSquaresResidual, residual * residual);
1672 for (
int j = 0; j < numRollingFrictionPoolConstraints; j++)
1678 btScalar rollingFrictionMagnitude = rollingFrictionConstraint.
m_friction * totalImpulse;
1679 if (rollingFrictionMagnitude > rollingFrictionConstraint.
m_friction)
1680 rollingFrictionMagnitude = rollingFrictionConstraint.
m_friction;
1682 rollingFrictionConstraint.
m_lowerLimit = -rollingFrictionMagnitude;
1683 rollingFrictionConstraint.
m_upperLimit = rollingFrictionMagnitude;
1686 leastSquaresResidual =
btMax(leastSquaresResidual, residual * residual);
1690 return leastSquaresResidual;
1695 BT_PROFILE(
"solveGroupCacheFriendlySplitImpulseIterations");
1700 for (iteration = 0; iteration < infoGlobal.
m_numIterations; iteration++)
1702 btScalar leastSquaresResidual = 0.f;
1706 for (j = 0; j < numPoolConstraints; j++)
1711 leastSquaresResidual =
btMax(leastSquaresResidual, residual * residual);
1714 if (leastSquaresResidual <= infoGlobal.m_leastSquaresResidualThreshold || iteration >= (infoGlobal.
m_numIterations - 1))
1716#ifdef VERBOSE_RESIDUAL_PRINTF
1717 printf(
"residual = %f at iteration #%d\n", leastSquaresResidual, iteration);
1728 BT_PROFILE(
"solveGroupCacheFriendlyIterations");
1736 for (
int iteration = 0; iteration <
maxIterations; iteration++)
1743#ifdef VERBOSE_RESIDUAL_PRINTF
1763 for (
int j = iBegin; j < iEnd; j++)
1783 for (
int j = iBegin; j < iEnd; j++)
1806 for (
int i = iBegin; i < iEnd; i++)
@ BT_CONTACT_FLAG_LATERAL_FRICTION_INITIALIZED
@ BT_CONTACT_FLAG_HAS_CONTACT_ERP
@ BT_CONTACT_FLAG_HAS_CONTACT_CFM
@ BT_CONTACT_FLAG_CONTACT_STIFFNESS_DAMPING
@ BT_CONTACT_FLAG_FRICTION_ANCHOR
const T & btMax(const T &a, const T &b)
btScalar dot(const btQuaternion &q1, const btQuaternion &q2)
Calculate the dot product between two quaternions.
@ BT_ENABLE_GYROSCOPIC_FORCE_IMPLICIT_BODY
@ BT_ENABLE_GYROSCOPIC_FORCE_EXPLICIT
BT_ENABLE_GYROPSCOPIC_FORCE flags is enabled by default in Bullet 2.83 and onwards.
@ BT_ENABLE_GYROSCOPIC_FORCE_IMPLICIT_WORLD
float btScalar
The btScalar type abstracts floating point numbers, to easily switch between double and single floati...
btScalar btSqrt(btScalar y)
btScalar btFabs(btScalar x)
static btScalar gResolveSingleConstraintRowGeneric_scalar_reference(btSolverBody &bodyA, btSolverBody &bodyB, const btSolverConstraint &c)
This is the scalar reference implementation of solving a single constraint row, the innerloop of the ...
static btScalar gResolveSingleConstraintRowLowerLimit_scalar_reference(btSolverBody &bodyA, btSolverBody &bodyB, const btSolverConstraint &c)
static btScalar gResolveSplitPenetrationImpulse_sse2(btSolverBody &bodyA, btSolverBody &bodyB, const btSolverConstraint &c)
int gNumSplitImpulseRecoveries
static btScalar gResolveSplitPenetrationImpulse_scalar_reference(btSolverBody &bodyA, btSolverBody &bodyB, const btSolverConstraint &c)
btScalar(* btSingleConstraintRowSolver)(btSolverBody &, btSolverBody &, const btSolverConstraint &)
static T sum(const btAlignedObjectArray< T > &items)
#define btSimdScalar
Until we get other contributions, only use SIMD on Windows, when using Visual Studio 2008 or later,...
void btPlaneSpace1(const T &n, T &p, T &q)
void resizeNoInitialize(int newsize)
resize changes the number of elements in the array.
int size() const
return the number of elements in the array
void resize(int newsize, const T &fillData=T())
T & expandNonInitializing()
T & expand(const T &fillValue=T())
btCollisionObject can be used to manage collision detection objects.
bool isStaticOrKinematicObject() const
btTransform & getWorldTransform()
const btVector3 & getAnisotropicFriction() const
int getInternalType() const
reserved for Bullet internal usage
int getWorldArrayIndex() const
bool hasAnisotropicFriction(int frictionMode=CF_ANISOTROPIC_FRICTION) const
void setCompanionId(int id)
bool isKinematicObject() const
@ CF_ANISOTROPIC_ROLLING_FRICTION
@ CF_ANISOTROPIC_FRICTION
int getCompanionId() const
static int getCpuFeatures()
The btDispatcher interface class can be used in combination with broadphase to dispatch calculations ...
The btIDebugDraw interface class allows hooking up a debug renderer to visually debug simulations.
ManifoldContactPoint collects and maintains persistent contactpoints.
btScalar m_combinedSpinningFriction
btScalar m_combinedRollingFriction
btScalar getDistance() const
btScalar m_combinedContactStiffness1
btScalar m_combinedRestitution
btVector3 m_lateralFrictionDir2
btScalar m_combinedContactDamping1
const btVector3 & getPositionWorldOnB() const
btScalar m_appliedImpulseLateral2
const btVector3 & getPositionWorldOnA() const
btScalar m_appliedImpulse
btScalar m_appliedImpulseLateral1
btVector3 m_normalWorldOnB
btScalar m_combinedFriction
btScalar m_contactMotion2
btVector3 m_lateralFrictionDir1
btScalar m_contactMotion1
btPersistentManifold is a contact point cache, it stays persistent as long as objects are overlapping...
const btManifoldPoint & getContactPoint(int index) const
const btCollisionObject * getBody0() const
const btCollisionObject * getBody1() const
int getNumContacts() const
btScalar getContactProcessingThreshold() const
The btRigidBody is the main class for rigid body objects.
btVector3 getVelocityInLocalPoint(const btVector3 &rel_pos) const
const btVector3 & getTotalTorque() const
btScalar getInvMass() const
const btVector3 & getLinearFactor() const
btVector3 computeGyroscopicImpulseImplicit_World(btScalar dt) const
perform implicit force computation in world space
btVector3 computeGyroscopicImpulseImplicit_Body(btScalar step) const
perform implicit force computation in body space (inertial frame)
const btVector3 & getAngularVelocity() const
const btVector3 & getTotalForce() const
const btVector3 & getAngularFactor() const
btScalar computeImpulseDenominator(const btVector3 &pos, const btVector3 &normal) const
static const btRigidBody * upcast(const btCollisionObject *colObj)
to keep collision detection and dynamics separate we don't store a rigidbody pointer but a rigidbody ...
const btMatrix3x3 & getInvInertiaTensorWorld() const
btVector3 computeGyroscopicForceExplicit(btScalar maxGyroscopicForce) const
explicit version is best avoided, it gains energy
const btVector3 & getLinearVelocity() const
btSingleConstraintRowSolver getScalarConstraintRowSolverLowerLimit()
Various implementations of solving a single constraint row using an inequality (lower limit) constrai...
void initSolverBody(btSolverBody *solverBody, btCollisionObject *collisionObject, btScalar timeStep)
btSingleConstraintRowSolver getSSE2ConstraintRowSolverGeneric()
btConstraintArray m_tmpSolverContactConstraintPool
int m_maxOverrideNumSolverIterations
virtual void convertBodies(btCollisionObject **bodies, int numBodies, const btContactSolverInfo &infoGlobal)
btSolverConstraint & addFrictionConstraint(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, const btContactSolverInfo &infoGlobal, btScalar desiredVelocity=0., btScalar cfmSlip=0.)
void writeBackJoints(int iBegin, int iEnd, const btContactSolverInfo &infoGlobal)
btConstraintArray m_tmpSolverContactFrictionConstraintPool
virtual btScalar solveGroupCacheFriendlyFinish(btCollisionObject **bodies, int numBodies, const btContactSolverInfo &infoGlobal)
btAlignedObjectArray< int > m_orderFrictionConstraintPool
virtual void convertJoints(btTypedConstraint **constraints, int numConstraints, const btContactSolverInfo &infoGlobal)
virtual ~btSequentialImpulseConstraintSolver()
btSolverAnalyticsData m_analyticsData
void convertJoint(btSolverConstraint *currentConstraintRow, btTypedConstraint *constraint, const btTypedConstraint::btConstraintInfo1 &info1, int solverBodyIdA, int solverBodyIdB, const btContactSolverInfo &infoGlobal)
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
btSolverConstraint & addTorsionalFrictionConstraint(const btVector3 &normalAxis, int solverBodyIdA, int solverBodyIdB, int frictionIndex, btManifoldPoint &cp, btScalar torsionalFriction, const btVector3 &rel_pos1, const btVector3 &rel_pos2, btCollisionObject *colObj0, btCollisionObject *colObj1, btScalar relaxation, btScalar desiredVelocity=0, btScalar cfmSlip=0.f)
virtual btScalar solveGroupCacheFriendlyIterations(btCollisionObject **bodies, int numBodies, btPersistentManifold **manifoldPtr, int numManifolds, btTypedConstraint **constraints, int numConstraints, const btContactSolverInfo &infoGlobal, btIDebugDraw *debugDrawer)
virtual void solveGroupCacheFriendlySplitImpulseIterations(btCollisionObject **bodies, int numBodies, btPersistentManifold **manifoldPtr, int numManifolds, btTypedConstraint **constraints, int numConstraints, const btContactSolverInfo &infoGlobal, btIDebugDraw *debugDrawer)
unsigned long m_btSeed2
m_btSeed2 is used for re-arranging the constraint rows. improves convergence/quality of friction
virtual void reset()
clear internal cached data and reset random seed
virtual void convertContacts(btPersistentManifold **manifoldPtr, int numManifolds, const btContactSolverInfo &infoGlobal)
btScalar resolveSingleConstraintRowLowerLimit(btSolverBody &bodyA, btSolverBody &bodyB, const btSolverConstraint &contactConstraint)
void setupSolverFunctions(bool useSimd)
static void applyAnisotropicFriction(btCollisionObject *colObj, btVector3 &frictionDirection, int frictionMode)
btSingleConstraintRowSolver getSSE2ConstraintRowSolverLowerLimit()
btScalar resolveSingleConstraintRowGeneric(btSolverBody &bodyA, btSolverBody &bodyB, const btSolverConstraint &contactConstraint)
void setupTorsionalFrictionConstraint(btSolverConstraint &solverConstraint, const btVector3 &normalAxis, int solverBodyIdA, int solverBodyIdB, btManifoldPoint &cp, btScalar combinedTorsionalFriction, const btVector3 &rel_pos1, const btVector3 &rel_pos2, btCollisionObject *colObj0, btCollisionObject *colObj1, btScalar relaxation, btScalar desiredVelocity=0., btScalar cfmSlip=0.)
btScalar m_leastSquaresResidual
void convertContact(btPersistentManifold *manifold, const btContactSolverInfo &infoGlobal)
btAlignedObjectArray< btSolverBody > m_tmpSolverBodyPool
btSingleConstraintRowSolver m_resolveSingleConstraintRowLowerLimit
btSingleConstraintRowSolver getScalarConstraintRowSolverGeneric()
Various implementations of solving a single constraint row using a generic equality constraint,...
btSingleConstraintRowSolver m_resolveSplitPenetrationImpulse
btAlignedObjectArray< btTypedConstraint::btConstraintInfo1 > m_tmpConstraintSizesPool
btAlignedObjectArray< int > m_orderTmpConstraintPool
btAlignedObjectArray< int > m_orderNonContactConstraintPool
btSingleConstraintRowSolver getSSE4_1ConstraintRowSolverGeneric()
void writeBackBodies(int iBegin, int iEnd, const btContactSolverInfo &infoGlobal)
btAlignedObjectArray< int > m_kinematicBodyUniqueIdToSolverBodyTable
virtual btScalar solveGroupCacheFriendlySetup(btCollisionObject **bodies, int numBodies, btPersistentManifold **manifoldPtr, int numManifolds, btTypedConstraint **constraints, int numConstraints, const btContactSolverInfo &infoGlobal, btIDebugDraw *debugDrawer)
void setupFrictionConstraint(btSolverConstraint &solverConstraint, const btVector3 &normalAxis, int solverBodyIdA, int solverBodyIdB, btManifoldPoint &cp, const btVector3 &rel_pos1, const btVector3 &rel_pos2, btCollisionObject *colObj0, btCollisionObject *colObj1, btScalar relaxation, const btContactSolverInfo &infoGlobal, btScalar desiredVelocity=0., btScalar cfmSlip=0.)
btConstraintArray m_tmpSolverNonContactConstraintPool
btSingleConstraintRowSolver m_resolveSingleConstraintRowGeneric
btSequentialImpulseConstraintSolver()
btConstraintArray m_tmpSolverContactRollingFrictionConstraintPool
void setFrictionConstraintImpulse(btSolverConstraint &solverConstraint, int solverBodyIdA, int solverBodyIdB, btManifoldPoint &cp, const btContactSolverInfo &infoGlobal)
btScalar resolveSingleConstraintRowLowerLimitSIMD(btSolverBody &bodyA, btSolverBody &bodyB, const btSolverConstraint &contactConstraint)
int getOrInitSolverBody(btCollisionObject &body, btScalar timeStep)
btScalar restitutionCurve(btScalar rel_vel, btScalar restitution, btScalar velocityThreshold)
btScalar resolveSingleConstraintRowGenericSIMD(btSolverBody &bodyA, btSolverBody &bodyB, const btSolverConstraint &contactConstraint)
btSingleConstraintRowSolver getSSE4_1ConstraintRowSolverLowerLimit()
void writeBackContacts(int iBegin, int iEnd, const btContactSolverInfo &infoGlobal)
virtual btScalar solveSingleIteration(int iteration, btCollisionObject **bodies, int numBodies, btPersistentManifold **manifoldPtr, int numManifolds, btTypedConstraint **constraints, int numConstraints, const btContactSolverInfo &infoGlobal, btIDebugDraw *debugDrawer)
btScalar resolveSplitPenetrationImpulse(btSolverBody &bodyA, btSolverBody &bodyB, const btSolverConstraint &contactConstraint)
void setupContactConstraint(btSolverConstraint &solverConstraint, int solverBodyIdA, int solverBodyIdB, btManifoldPoint &cp, const btContactSolverInfo &infoGlobal, btScalar &relaxation, const btVector3 &rel_pos1, const btVector3 &rel_pos2)
TypedConstraint is the baseclass for Bullet constraints and vehicles.
virtual void solveConstraintObsolete(btSolverBody &, btSolverBody &, btScalar)
internal method used by the constraint solver, don't use them directly
void setEnabled(bool enabled)
int getOverrideNumSolverIterations() const
virtual void buildJacobian()
internal method used by the constraint solver, don't use them directly
virtual void getInfo2(btConstraintInfo2 *info)=0
internal method used by the constraint solver, don't use them directly
void internalSetAppliedImpulse(btScalar appliedImpulse)
internal method used by the constraint solver, don't use them directly
const btRigidBody & getRigidBodyA() const
btScalar getBreakingImpulseThreshold() const
const btRigidBody & getRigidBodyB() const
virtual void getInfo1(btConstraintInfo1 *info)=0
internal method used by the constraint solver, don't use them directly
const btJointFeedback * getJointFeedback() const
btVector3 can be used to represent 3D points and vectors.
btScalar length() const
Return the length of the vector.
btVector3 cross(const btVector3 &v) const
Return the cross product between this and another vector.
btScalar dot(const btVector3 &v) const
Return the dot product.
void setValue(const btScalar &_x, const btScalar &_y, const btScalar &_z)
btScalar length2() const
Return the length of the vector squared.
btVector3 & normalize()
Normalize this vector x^2 + y^2 + z^2 = 1.
btVector3 m_appliedForceBodyA
btVector3 m_appliedTorqueBodyA
btVector3 m_appliedForceBodyB
btVector3 m_appliedTorqueBodyB
int m_numContactManifolds
double m_remainingLeastSquaresResidual
The btSolverBody is an internal datastructure for the constraint solver. Only necessary data is packe...
const btVector3 & getPushVelocity() const
const btVector3 & getTurnVelocity() const
const btVector3 & getDeltaLinearVelocity() const
btVector3 & internalGetDeltaAngularVelocity()
btVector3 m_angularVelocity
btRigidBody * m_originalBody
void internalApplyPushImpulse(const btVector3 &linearComponent, const btVector3 &angularComponent, btScalar impulseMagnitude)
btVector3 & internalGetTurnVelocity()
btVector3 m_linearVelocity
void getVelocityInLocalPointNoDelta(const btVector3 &rel_pos, btVector3 &velocity) const
const btVector3 & getDeltaAngularVelocity() const
btTransform m_worldTransform
btVector3 & internalGetPushVelocity()
btVector3 & internalGetDeltaLinearVelocity()
some internal methods, don't use them
void internalSetInvMass(const btVector3 &invMass)
btVector3 m_angularFactor
void internalApplyImpulse(const btVector3 &linearComponent, const btVector3 &angularComponent, const btScalar impulseMagnitude)
btVector3 m_externalTorqueImpulse
const btVector3 & internalGetInvMass() const
btVector3 m_externalForceImpulse
1D constraint along a normal axis between bodyA and bodyB. It can be combined to solve contact and fr...
void * m_originalContactPoint
btVector3 m_contactNormal2
btVector3 m_relpos1CrossNormal
btVector3 m_angularComponentB
btSimdScalar m_appliedImpulse
int m_overrideNumSolverIterations
btScalar m_rhsPenetration
btVector3 m_angularComponentA
btSimdScalar m_appliedPushImpulse
btVector3 m_relpos2CrossNormal
btVector3 m_contactNormal1
btScalar * m_J2angularAxis
btScalar * m_J1linearAxis
btScalar * m_J2linearAxis
btScalar * m_J1angularAxis
btScalar * m_constraintError