00001 /* 00002 * Copyright (c) 2016, Lukas Pfeifhofer <lukas.pfeifhofer@devlabs.pro> 00003 * All rights reserved. 00004 * 00005 * Redistribution and use in source and binary forms, with or without 00006 * modification, are permitted provided that the following conditions are met: 00007 * 00008 * 1. Redistributions of source code must retain the above copyright notice, 00009 * this list of conditions and the following disclaimer. 00010 * 00011 * 2. Redistributions in binary form must reproduce the above copyright notice, 00012 * this list of conditions and the following disclaimer in the documentation 00013 * and/or other materials provided with the distribution. 00014 * 00015 * 3. Neither the name of the copyright holder nor the names of its contributors 00016 * may be used to endorse or promote products derived from this software without 00017 * specific prior written permission. 00018 * 00019 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" 00020 * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 00021 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 00022 * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE 00023 * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR 00024 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF 00025 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS 00026 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN 00027 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) 00028 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE 00029 * POSSIBILITY OF SUCH DAMAGE. 00030 */ 00031 00032 #ifndef MARKER_WITH_COVARIANCE_VISUAL_H 00033 #define MARKER_WITH_COVARIANCE_VISUAL_H 00034 00035 #include <marker_msgs/MarkerWithCovarianceStamped.h> 00036 #include "ogre_visuals/marker.h" 00037 #include "ogre_visuals/marker_with_covariance.h" 00038 00039 namespace Ogre { 00040 class Vector3; 00041 00042 class Quaternion; 00043 } 00044 00045 namespace rviz { 00046 class Axes; 00047 } 00048 00049 namespace marker_rviz_plugin { 00050 00051 class MarkerWithCovarianceVisual { 00052 public: 00053 MarkerWithCovarianceVisual(Ogre::SceneManager *scene_manager, Ogre::SceneNode *parent_node); 00054 00055 virtual ~MarkerWithCovarianceVisual(); 00056 00057 // Configure the visual to show the data in the message. 00058 void setMessage(const marker_msgs::MarkerWithCovarianceStamped::ConstPtr &msg); 00059 00060 // Set the pose of the coordinate frame the message refers to. 00061 // These could be done inside setMessage(), but that would require 00062 // calls to FrameManager and error handling inside setMessage(), 00063 // which doesn't seem as clean. This way MarkerDetectionVisual is 00064 // only responsible for visualization. 00065 void setFramePosition(const Ogre::Vector3 &position); 00066 00067 void setFrameOrientation(const Ogre::Quaternion &orientation); 00068 00069 void setShowAxes(bool showAxes); 00070 00071 void setShowMarker(bool showMarker); 00072 00073 void setShowLabel(bool showLabel); 00074 00075 void setScale(float scale); 00076 00077 private: 00078 boost::shared_ptr<Marker> _marker; 00079 00080 Ogre::SceneNode *frame_node_; 00081 Ogre::SceneManager *scene_manager_; 00082 00083 bool _showAxes; 00084 bool _showMarker; 00085 bool _showLabel; 00086 float _scale; 00087 }; 00088 00089 } // end namespace marker_rviz_plugin 00090 00091 #endif // MARKER_WITH_COVARIANCE_VISUAL_H