fix applied too fast

This commit is contained in:
Erwin Coumans
2018-08-03 17:57:09 -07:00
parent 02b0e34bda
commit 684b69f4dd

View File

@@ -967,12 +967,11 @@ void btMultiBody::computeAccelerationsArticulatedBodyAlgorithmMultiDof(btScalar
//
Y[m_links[i].m_dofOffset + dof] = m_links[i].m_jointTorque[dof]
- m_links[i].m_axes[dof].dot(zeroAccSpatFrc[i+1])
- spatCoriolisAcc[i].dot(hDof)
;
- spatCoriolisAcc[i].dot(hDof);
}
for(int dof = 0; dof < m_links[i].m_dofCount; ++dof)
}
{
btScalar *D_row = &D[dof * m_links[i].m_dofCount];
for(int dof2 = 0; dof2 < m_links[i].m_dofCount; ++dof2)
{