relative_humidity_display.cpp
Go to the documentation of this file.
1 /*
2  * Copyright (c) 2012, Willow Garage, Inc.
3  * All rights reserved.
4  *
5  * Redistribution and use in source and binary forms, with or without
6  * modification, are permitted provided that the following conditions are met:
7  *
8  * * Redistributions of source code must retain the above copyright
9  * notice, this list of conditions and the following disclaimer.
10  * * Redistributions in binary form must reproduce the above copyright
11  * notice, this list of conditions and the following disclaimer in the
12  * documentation and/or other materials provided with the distribution.
13  * * Neither the name of the Willow Garage, Inc. nor the names of its
14  * contributors may be used to endorse or promote products derived from
15  * this software without specific prior written permission.
16  *
17  * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
18  * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
19  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
20  * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE
21  * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
22  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
23  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
24  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
25  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
26  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
27  * POSSIBILITY OF SUCH DAMAGE.
28  */
29 
30 #include <OgreSceneNode.h>
31 #include <OgreSceneManager.h>
32 
33 #include <ros/time.h>
34 
37 #include "rviz/display_context.h"
38 #include "rviz/frame_manager.h"
41 #include "rviz/validate_floats.h"
42 
44 
45 namespace rviz
46 {
47 
49  : point_cloud_common_( new PointCloudCommon( this ))
50 {
51  queue_size_property_ = new IntProperty( "Queue Size", 10,
52  "Advanced: set the size of the incoming RelativeHumidity message queue. "
53  " Increasing this is useful if your incoming TF data is delayed significantly "
54  "from your RelativeHumidity data, but it can greatly increase memory usage if the messages are big.",
55  this, SLOT( updateQueueSize() ));
56 
57  // PointCloudCommon sets up a callback queue with a thread for each
58  // instance. Use that for processing incoming messages.
60 }
61 
63 {
64  delete point_cloud_common_;
65 }
66 
68 {
71 
72  // Set correct initial values
73  subProp("Channel Name")->setValue("relative_humidity");
74  subProp("Autocompute Intensity Bounds")->setValue(false);
75  subProp("Min Intensity")->setValue(0.0); // 0% relative humidity
76  subProp("Max Intensity")->setValue(1.0); // 100% relative humidity
77 }
78 
80 {
82 }
83 
84 void RelativeHumidityDisplay::processMessage( const sensor_msgs::RelativeHumidityConstPtr& msg )
85 {
86  sensor_msgs::PointCloud2Ptr filtered(new sensor_msgs::PointCloud2);
87 
88  // Create fields
89  sensor_msgs::PointField x;
90  x.name = "x";
91  x.offset = 0;
92  x.datatype = sensor_msgs::PointField::FLOAT32;
93  x.count = 1;
94  sensor_msgs::PointField y;
95  y.name = "y";
96  y.offset = 4;
97  y.datatype = sensor_msgs::PointField::FLOAT32;
98  y.count = 1;
99  sensor_msgs::PointField z;
100  z.name = "z";
101  z.offset = 8;
102  z.datatype = sensor_msgs::PointField::FLOAT32;
103  z.count = 1;
104  sensor_msgs::PointField relative_humidity;
105  relative_humidity.name = "relative_humidity";
106  relative_humidity.offset = 12;
107  relative_humidity.datatype = sensor_msgs::PointField::FLOAT64;
108  relative_humidity.count = 1;
109 
110  // Create pointcloud from message
111  filtered->header = msg->header;
112  filtered->fields.push_back(x);
113  filtered->fields.push_back(y);
114  filtered->fields.push_back(z);
115  filtered->fields.push_back(relative_humidity);
116  filtered->data.resize(20);
117  const float zero_float = 0.0; // RelativeHumidity is always on its tf frame
118  memcpy(&filtered->data[x.offset], &zero_float, 4);
119  memcpy(&filtered->data[y.offset], &zero_float, 4);
120  memcpy(&filtered->data[z.offset], &zero_float, 4);
121  memcpy(&filtered->data[relative_humidity.offset], &msg->relative_humidity, 8);
122  filtered->height = 1;
123  filtered->width = 1;
124  filtered->is_bigendian = false;
125  filtered->point_step = 20;
126  filtered->row_step = 1;
127 
128  // Give to point_cloud_common to draw
129  point_cloud_common_->addMessage( filtered );
130 }
131 
132 
133 void RelativeHumidityDisplay::update( float wall_dt, float ros_dt )
134 {
135  point_cloud_common_->update( wall_dt, ros_dt );
136 
137  // Hide unneeded properties
138  subProp("Position Transformer")->hide();
139  subProp("Color Transformer")->hide();
140  subProp("Channel Name")->hide();
141  subProp("Autocompute Intensity Bounds")->hide();
142 }
143 
145 {
146  MFDClass::reset();
148 }
149 
150 } // namespace rviz
151 
virtual void processMessage(const sensor_msgs::RelativeHumidityConstPtr &msg)
Process a single message. Overridden from MessageFilterDisplay.
virtual void reset()
Called to tell the display to clear its state.
DisplayContext * context_
This DisplayContext pointer is the main connection a Display has into the rest of rviz...
Definition: display.h:256
Displays a RelativeHumidity message of type sensor_msgs::RelativeHumidity.
virtual bool setValue(const QVariant &new_value)
Set the new value for this property. Returns true if the new value is different from the old value...
Definition: property.cpp:130
virtual int getInt() const
Return the internal property value as an integer.
Definition: int_property.h:73
ros::NodeHandle update_nh_
A NodeHandle whose CallbackQueue is run from the main GUI thread (the "update" thread).
Definition: display.h:269
virtual void onInitialize()
Do initialization. Overridden from MessageFilterDisplay.
ros::CallbackQueueInterface * getCallbackQueue()
void initialize(DisplayContext *context, Ogre::SceneNode *scene_node)
tf::MessageFilter< sensor_msgs::RelativeHumidity > * tf_filter_
TFSIMD_FORCE_INLINE const tfScalar & y() const
Property specialized to provide max/min enforcement for integers.
Definition: int_property.h:38
virtual void update(float wall_dt, float ros_dt)
Called periodically by the visualization manager.
Ogre::SceneNode * scene_node_
The Ogre::SceneNode to hold all 3D scene elements shown by this Display.
Definition: display.h:264
Displays a point cloud of type sensor_msgs::PointCloud.
virtual void setQueueSize(uint32_t new_queue_size)
virtual Property * subProp(const QString &sub_name)
Return the first child Property with the given name, or the FailureProperty if no child has the name...
Definition: property.cpp:174
void addMessage(const sensor_msgs::PointCloudConstPtr &cloud)
void setCallbackQueue(CallbackQueueInterface *queue)
TFSIMD_FORCE_INLINE const tfScalar & x() const
TFSIMD_FORCE_INLINE const tfScalar & z() const
void hide()
Hide this Property in any PropertyTreeWidgets.
Definition: property.h:371
#define PLUGINLIB_EXPORT_CLASS(class_type, base_class_type)
void update(float wall_dt, float ros_dt)


rviz
Author(s): Dave Hershberger, David Gossow, Josh Faust
autogenerated on Wed Aug 28 2019 04:01:51