diff --git a/src/BulletDynamics/Featherstone/btMultiBodyLink.h b/src/BulletDynamics/Featherstone/btMultiBodyLink.h index 565bb6b3e..01d5583c2 100644 --- a/src/BulletDynamics/Featherstone/btMultiBodyLink.h +++ b/src/BulletDynamics/Featherstone/btMultiBodyLink.h @@ -197,7 +197,7 @@ struct btMultibodyLink { btScalar *pJointPos = (pq ? pq : &m_jointPos[0]); btQuaternion& cachedRot = m_cachedRotParentToThis; - btVector3& cachedVector =m_cachedRVector; + btVector3& cachedVector = m_cachedRVector; switch (m_jointType) { case eRevolute: @@ -241,6 +241,8 @@ struct btMultibodyLink btAssert(0); } } + m_cachedRotParentToThis_interpolate = m_cachedRotParentToThis; + m_cachedRVector_interpolate = m_cachedRVector; } void updateInterpolationCacheMultiDof()