diff --git a/src/BulletSoftBody/btDeformableBodySolver.cpp b/src/BulletSoftBody/btDeformableBodySolver.cpp index b7c531385..41a5df70d 100644 --- a/src/BulletSoftBody/btDeformableBodySolver.cpp +++ b/src/BulletSoftBody/btDeformableBodySolver.cpp @@ -87,21 +87,22 @@ void btDeformableBodySolver::postStabilize() if (dp < 0) { c.m_node->m_x -= dp * cti.m_normal * c.m_c4; +// c.m_node->m_x -= impulse * c.m_c2; //// -// if (cti.m_colObj->getInternalType() == btCollisionObject::CO_RIGID_BODY) -// { -// if (rigidCol) -// rigidCol->applyImpulse(impulse, c.m_c1); -// } -// else if (cti.m_colObj->getInternalType() == btCollisionObject::CO_FEATHERSTONE_LINK) -// { -// if (multibodyLinkCol) -// { -// double multiplier = 0.5; -// multibodyLinkCol->m_multiBody->applyDeltaVeeMultiDof(deltaV, -impulse.length() * multiplier); -// } -// } + if (cti.m_colObj->getInternalType() == btCollisionObject::CO_RIGID_BODY) + { + if (rigidCol) + rigidCol->applyImpulse(impulse, c.m_c1); + } + else if (cti.m_colObj->getInternalType() == btCollisionObject::CO_FEATHERSTONE_LINK) + { + if (multibodyLinkCol) + { + double multiplier = 0.5; + multibodyLinkCol->m_multiBody->applyDeltaVeeMultiDof(deltaV, -impulse.length() * multiplier); + } + } } } }