Fix errors while orientation covariance visualization in CovarianceVi…

…sual
ros-visualization · Aug 24, 2020 · 4affaad · 4affaad
1 parent 26c52b6
commit 4affaad
Showing 1 changed file with 2 additions and 1 deletion.
diff --git a/src/rviz/default_plugin/covariance_visual.cpp b/src/rviz/default_plugin/covariance_visual.cpp
@@ -273,7 +273,7 @@ CovarianceVisual::CovarianceVisual(Ogre::SceneManager* scene_manager,
   // x-axis (roll)
   orientation_offset_node_[kRoll]->setPosition(Ogre::Vector3::UNIT_X);
   orientation_offset_node_[kRoll]->setOrientation(
-      Ogre::Quaternion(Ogre::Degree(90), Ogre::Vector3::UNIT_X) *
+      Ogre::Quaternion(Ogre::Degree(-90), Ogre::Vector3::UNIT_X) *
       Ogre::Quaternion(Ogre::Degree(90), Ogre::Vector3::UNIT_Z));
   // y-axis (pitch)
   orientation_offset_node_[kPitch]->setPosition(Ogre::Vector3(Ogre::Vector3::UNIT_Y));
@@ -282,6 +282,7 @@ CovarianceVisual::CovarianceVisual(Ogre::SceneManager* scene_manager,
   // z-axis (yaw)
   orientation_offset_node_[kYaw]->setPosition(Ogre::Vector3(Ogre::Vector3::UNIT_Z));
   orientation_offset_node_[kYaw]->setOrientation(
+      Ogre::Quaternion(Ogre::Degree(90), Ogre::Vector3::UNIT_Z) *
       Ogre::Quaternion(Ogre::Degree(90), Ogre::Vector3::UNIT_X));
   // z-axis (yaw 2D)
   // NOTE: rviz use a cone defined by the file rviz/ogre_media/models/rviz_cone.mesh, and it's