32 #include <OGRE/OgreVector3.h> 33 #include <OGRE/OgreSceneNode.h> 34 #include <OGRE/OgreSceneManager.h> 35 #include <OGRE/OgreEntity.h> 59 marker_msgs::MarkerWithCovariance marker_cov = msg->marker;
60 marker_msgs::Marker
marker = marker_cov.marker;
62 double p_x = marker.pose.position.x;
63 double p_y = marker.pose.position.y;
64 double p_z = marker.pose.position.z;
65 double o_x = marker.pose.orientation.x;
66 double o_y = marker.pose.orientation.y;
67 double o_z = marker.pose.orientation.z;
68 double o_w = marker.pose.orientation.w;
71 if (marker.ids.size() > 0)
76 m->setOrientation(Ogre::Quaternion(o_w, o_x, o_y, o_z));
81 m->setCovarianceMatrix(msg->marker.covariance);
99 _marker->setShowMarker(showMarker);
104 _marker->setShowLabel(showLabel);
109 _marker->setScale(Ogre::Vector3(scale, scale, scale));
void setShowAxes(bool showAxes)
void setShowMarker(bool showMarker)
void setScale(float scale)
void setMessage(const marker_msgs::MarkerWithCovarianceStamped::ConstPtr &msg)
Ogre::SceneManager * scene_manager_
void setFramePosition(const Ogre::Vector3 &position)
virtual ~MarkerWithCovarianceVisual()
MarkerWithCovarianceVisual(Ogre::SceneManager *scene_manager, Ogre::SceneNode *parent_node)
void setFrameOrientation(const Ogre::Quaternion &orientation)
boost::shared_ptr< Marker > _marker
virtual void setPosition(const Ogre::Vector3 &position)
Ogre::SceneNode * frame_node_
void setShowLabel(bool showLabel)