diff --git a/ambf_plugins/core/ros_comm_plugin/ObjectCommPlugin.cpp b/ambf_plugins/core/ros_comm_plugin/ObjectCommPlugin.cpp index 8af5e6d54..787e00508 100644 --- a/ambf_plugins/core/ros_comm_plugin/ObjectCommPlugin.cpp +++ b/ambf_plugins/core/ros_comm_plugin/ObjectCommPlugin.cpp @@ -736,7 +736,7 @@ void afObjectCommunicationPlugin::rigidBodyUpdateState(afRigidBodyPtr afRBPtr, d setTimeStamps(m_objectPtr->m_afWorld->getWallTime(), m_objectPtr->m_afWorld->getSimulationTime(), m_objectPtr->getCurrentTimeStamp()); btRigidBody* btRBPtr = afRBPtr->m_bulletRigidBody; cQuaternion q; - q.fromRotMat(afRBPtr->m_visualMesh->getLocalRot()); + q.fromRotMat(afRBPtr->getLocalRot()); // Update the Pose cVector3d localPos = afRBPtr->getLocalPos();