Searched refs:linkRotMat (Results 1 – 4 of 4) sorted by relevance
961 const btMatrix3x3& linkRotMat = mb->getLink(l).m_cachedWorldTransform.getBasis(); in processRequestActualStateCommand()962 worldLinVel = linkRotMat * linVel[l+1]; in processRequestActualStateCommand()963 worldAngVel = linkRotMat * omega[l+1]; in processRequestActualStateCommand()
7926 const btMatrix3x3& linkRotMat = mb->getLink(l).m_cachedWorldTransform.getBasis(); in processRequestActualStateCommand() local7927 worldLinVel = linkRotMat * linVel[l + 1]; in processRequestActualStateCommand()7928 worldAngVel = linkRotMat * omega[l + 1]; in processRequestActualStateCommand()