fix CMD_INIT_POSE+INIT_POSE_HAS_INITIAL_ORIENTATION,
setWorldToBaseRot takes inverse orientation (need to remove that API!)
This commit is contained in:
@@ -1836,11 +1836,12 @@ bool PhysicsServerCommandProcessor::processCommand(const struct SharedMemoryComm
|
|||||||
clientCmd.m_initPoseArgs.m_hasInitialStateQ[6]);
|
clientCmd.m_initPoseArgs.m_hasInitialStateQ[6]);
|
||||||
|
|
||||||
mb->setBaseOmega(btVector3(0,0,0));
|
mb->setBaseOmega(btVector3(0,0,0));
|
||||||
mb->setWorldToBaseRot(btQuaternion(
|
btQuaternion invOrn(clientCmd.m_initPoseArgs.m_initialStateQ[3],
|
||||||
clientCmd.m_initPoseArgs.m_initialStateQ[3],
|
|
||||||
clientCmd.m_initPoseArgs.m_initialStateQ[4],
|
clientCmd.m_initPoseArgs.m_initialStateQ[4],
|
||||||
clientCmd.m_initPoseArgs.m_initialStateQ[5],
|
clientCmd.m_initPoseArgs.m_initialStateQ[5],
|
||||||
clientCmd.m_initPoseArgs.m_initialStateQ[6]));
|
clientCmd.m_initPoseArgs.m_initialStateQ[6]);
|
||||||
|
|
||||||
|
mb->setWorldToBaseRot(invOrn.inverse());
|
||||||
}
|
}
|
||||||
if (clientCmd.m_updateFlags & INIT_POSE_HAS_JOINT_STATE)
|
if (clientCmd.m_updateFlags & INIT_POSE_HAS_JOINT_STATE)
|
||||||
{
|
{
|
||||||
|
|||||||
Reference in New Issue
Block a user