fix applied too fast
This commit is contained in:
@@ -967,12 +967,11 @@ void btMultiBody::computeAccelerationsArticulatedBodyAlgorithmMultiDof(btScalar
|
|||||||
//
|
//
|
||||||
Y[m_links[i].m_dofOffset + dof] = m_links[i].m_jointTorque[dof]
|
Y[m_links[i].m_dofOffset + dof] = m_links[i].m_jointTorque[dof]
|
||||||
- m_links[i].m_axes[dof].dot(zeroAccSpatFrc[i+1])
|
- 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)
|
for(int dof = 0; dof < m_links[i].m_dofCount; ++dof)
|
||||||
}
|
{
|
||||||
btScalar *D_row = &D[dof * m_links[i].m_dofCount];
|
btScalar *D_row = &D[dof * m_links[i].m_dofCount];
|
||||||
for(int dof2 = 0; dof2 < m_links[i].m_dofCount; ++dof2)
|
for(int dof2 = 0; dof2 < m_links[i].m_dofCount; ++dof2)
|
||||||
{
|
{
|
||||||
|
|||||||
Reference in New Issue
Block a user