Searched refs:multiBodyA (Results 1 – 2 of 2) sorted by relevance
79 btMultiBody* multiBodyA = solverConstraint.m_multiBodyA; in fillMultiBodyConstraint() local82 …btSolverBody* bodyA = multiBodyA ? 0 : &data.m_solverBodyPool->at(solverConstraint.m_solverBodyIdA… in fillMultiBodyConstraint()85 btRigidBody* rb0 = multiBodyA ? 0 : bodyA->m_originalBody; in fillMultiBodyConstraint()94 if (multiBodyA) in fillMultiBodyConstraint()98 rel_pos1 = posAworld - multiBodyA->getBasePos(); in fillMultiBodyConstraint()101 …rel_pos1 = posAworld - multiBodyA->getLink(solverConstraint.m_linkA).m_cachedWorldTransform.getOri… in fillMultiBodyConstraint()104 …const int ndofA = (multiBodyA->isMultiDof() ? multiBodyA->getNumDofs() : multiBodyA->getNumLinks(… in fillMultiBodyConstraint()106 solverConstraint.m_deltaVelAindex = multiBodyA->getCompanionId(); in fillMultiBodyConstraint()111 multiBodyA->setCompanionId(solverConstraint.m_deltaVelAindex); in fillMultiBodyConstraint()131 if(multiBodyA->isMultiDof()) in fillMultiBodyConstraint()[all …]
268 btMultiBody* multiBodyA = solverConstraint.m_multiBodyA; in setupMultiBodyContactConstraint() local274 btSolverBody* bodyA = multiBodyA ? 0 : &m_tmpSolverBodyPool[solverConstraint.m_solverBodyIdA]; in setupMultiBodyContactConstraint()277 btRigidBody* rb0 = multiBodyA ? 0 : bodyA->m_originalBody; in setupMultiBodyContactConstraint()290 if (multiBodyA) in setupMultiBodyContactConstraint()294 rel_pos1 = pos1 - multiBodyA->getBasePos(); in setupMultiBodyContactConstraint()297 …rel_pos1 = pos1 - multiBodyA->getLink(solverConstraint.m_linkA).m_cachedWorldTransform.getOrigin(); in setupMultiBodyContactConstraint()299 …const int ndofA = (multiBodyA->isMultiDof() ? multiBodyA->getNumDofs() : multiBodyA->getNumLinks(… in setupMultiBodyContactConstraint()301 solverConstraint.m_deltaVelAindex = multiBodyA->getCompanionId(); in setupMultiBodyContactConstraint()306 multiBodyA->setCompanionId(solverConstraint.m_deltaVelAindex); in setupMultiBodyContactConstraint()319 if(multiBodyA->isMultiDof()) in setupMultiBodyContactConstraint()[all …]