FeatureTrackerNode class Connects to the ROS communication system to get messages from the sensors and publish results Templated in the state of to be estimated by this RE level (ROS type) The received messages are passed to the FeatureTracker object to be processed. More...
#include <FeatureTrackerNode.h>
Public Member Functions | |
virtual void | AdvanceBagCallbackFromShapeReconstruction (const boost::shared_ptr< std_msgs::Bool const > &flag) |
virtual void | AdvanceBagCallbackFromShapeTracker (const boost::shared_ptr< omip_msgs::ShapeTrackerStates const > &st_states) |
virtual void | DynamicReconfigureCallback (feature_tracker::FeatureTrackerDynReconfConfig &config, uint32_t level) |
Callback for the Dynamic Reconfigure parameters. More... | |
FeatureTrackerNode () | |
virtual void | measurementCallback (const sensor_msgs::PointCloud2ConstPtr &pc_msg, const sensor_msgs::ImageConstPtr &depth_image_msg, const sensor_msgs::ImageConstPtr &rgb_image_msg) |
Combined callback for the measurements of this RE level: point cloud, depth image and rgb image. More... | |
virtual void | measurementCallback (const sensor_msgs::ImageConstPtr &depth_image_msg, const sensor_msgs::ImageConstPtr &rgb_image_msg) |
Lighter version of the combined callback for the measurements of this RE level: depth image and rgb image. More... | |
virtual void | measurementCallback (const boost::shared_ptr< ft_measurement_ros_t const > &ft_measurement_ros) |
Empty measurement callback, just to implement correctly the RENode interface. More... | |
virtual void | OcclusionMaskImgCallback (const sensor_msgs::ImageConstPtr &occlusion_mask_img) |
Callback for the mask of the self occlusion of the robot. Only for the WAM. More... | |
virtual void | PublishDepthEdgesImg () |
Publish an image with the edges detected on the depth map. More... | |
virtual void | PublishDepthImg () |
virtual void | PublishDetectingMaskImg () |
Publish the mask used to detect new features. Combines edges, max depth and mask of current features (to not detect them) More... | |
virtual void | PublishFullRGBDPC () |
Publish the full RGB-D point cloud used in the last iteration (used to synchronize the PC to the other published messages) More... | |
virtual void | PublishPredictedAndLastFeaturesImg () |
Publish an image with the last feature locations and the predicted feature locations. More... | |
virtual void | PublishPredictionMaskImg () |
Publish the mask of the predictions. More... | |
virtual void | PublishRGBImg () |
virtual void | PublishTrackedFeaturesImg () |
Publish an image with the last tracked features on it. More... | |
virtual void | PublishTrackedFeaturesWithPredictionMaskImg () |
Publish an image with the last tracked features together with the mask of the predictions. More... | |
virtual void | PublishTrackingMaskImg () |
Publish the mask used to track features. Combines edges, predictions mask and max depth. More... | |
virtual void | ReadRosBag () |
Read messages from a rosbag instead of receiving them from a sensor Internally it "publishes" the messages that are then received by the measurement callback. More... | |
virtual void | RepublishPredictedFeatLocation () |
virtual void | run () |
virtual void | statePredictionCallback (const boost::shared_ptr< ft_state_ros_t const > &predicted_next_state) |
Callback for the predictions about the state of this RE level coming from the higher level of the hierarchy. More... | |
virtual | ~FeatureTrackerNode () |
Public Member Functions inherited from omip::RecursiveEstimatorNodeInterface< ft_measurement_ros_t, ft_state_ros_t, FeatureTracker > | |
bool | getROSParameter (std::string param_name, T ¶m_container) |
bool | getROSParameter (std::string param_name, T ¶m_container, const T &default_value) |
virtual void | measurementCallback (const boost::shared_ptr< MeasurementTypeROS const > &measurement)=0 |
virtual void | quitCallback (const std_msgs::EmptyConstPtr &msg) |
RecursiveEstimatorNodeInterface (int num_external_state_predictors) | |
virtual void | spinStatePredictorQueue (int state_prediction_queue_idx) |
virtual void | statePredictionCallback (const boost::shared_ptr< StateTypeROS const > &predicted_next_state)=0 |
virtual | ~RecursiveEstimatorNodeInterface () |
Protected Member Functions | |
virtual void | _InitializeVariables () |
virtual void | _publishPredictedMeasurement () const |
Publish the prediction about the next measurement by this RE level. More... | |
virtual void | _publishState () const |
Publish the current state of this RE level. More... | |
virtual void | _ReadParameters () |
virtual void | _SubscribeAndAdvertiseTopics () |
Private Types | |
typedef message_filters::sync_policies::ApproximateTime< sensor_msgs::Image, sensor_msgs::Image > | FTrackerLightSyncPolicy |
typedef message_filters::sync_policies::ApproximateTime< sensor_msgs::PointCloud2, sensor_msgs::Image, sensor_msgs::Image > | FTrackerSyncPolicy |
FeatureTrackerNode class Connects to the ROS communication system to get messages from the sensors and publish results Templated in the state of to be estimated by this RE level (ROS type) The received messages are passed to the FeatureTracker object to be processed.
Definition at line 84 of file FeatureTrackerNode.h.
|
private |
Definition at line 89 of file FeatureTrackerNode.h.
|
private |
Definition at line 88 of file FeatureTrackerNode.h.
FeatureTrackerNode::FeatureTrackerNode | ( | ) |
Constructor
Definition at line 30 of file FeatureTrackerNode.cpp.
|
virtual |
Destructor
Definition at line 67 of file FeatureTrackerNode.cpp.
|
protectedvirtual |
Initialize variables
Definition at line 651 of file FeatureTrackerNode.cpp.
|
protectedvirtual |
Publish the prediction about the next measurement by this RE level.
Implements omip::RecursiveEstimatorNodeInterface< ft_measurement_ros_t, ft_state_ros_t, FeatureTracker >.
Definition at line 558 of file FeatureTrackerNode.cpp.
|
protectedvirtual |
Publish the current state of this RE level.
Implements omip::RecursiveEstimatorNodeInterface< ft_measurement_ros_t, ft_state_ros_t, FeatureTracker >.
Definition at line 546 of file FeatureTrackerNode.cpp.
|
protectedvirtual |
Read parameters from configuration file
Definition at line 563 of file FeatureTrackerNode.cpp.
|
protectedvirtual |
Subscribe and advertise topics for this node
Definition at line 715 of file FeatureTrackerNode.cpp.
|
virtual |
Definition at line 814 of file FeatureTrackerNode.cpp.
|
virtual |
Definition at line 820 of file FeatureTrackerNode.cpp.
|
virtual |
Callback for the Dynamic Reconfigure parameters.
config | Values from the Dynamic Reconfigure server |
level |
Definition at line 232 of file FeatureTrackerNode.cpp.
|
virtual |
Combined callback for the measurements of this RE level: point cloud, depth image and rgb image.
pc_msg | Input full RGBD point cloud |
depth_image_msg | Input depth image |
rgb_image_msg | Input RGB image |
Definition at line 71 of file FeatureTrackerNode.cpp.
|
virtual |
Lighter version of the combined callback for the measurements of this RE level: depth image and rgb image.
depth_image_msg | Input depth image |
rgb_image_msg | Input RGB image |
Definition at line 85 of file FeatureTrackerNode.cpp.
|
inlinevirtual |
Empty measurement callback, just to implement correctly the RENode interface.
ft_measurement_ros | Empty message. Only to implement the interface |
Definition at line 132 of file FeatureTrackerNode.h.
|
virtual |
Callback for the mask of the self occlusion of the robot. Only for the WAM.
occlusion_mask_img | Mask image with the area of the visual field covered by the WAM robot |
Definition at line 408 of file FeatureTrackerNode.cpp.
|
virtual |
Publish an image with the edges detected on the depth map.
Definition at line 477 of file FeatureTrackerNode.cpp.
|
virtual |
Definition at line 428 of file FeatureTrackerNode.cpp.
|
virtual |
Publish the mask used to detect new features. Combines edges, max depth and mask of current features (to not detect them)
Definition at line 511 of file FeatureTrackerNode.cpp.
|
virtual |
Publish the full RGB-D point cloud used in the last iteration (used to synchronize the PC to the other published messages)
Definition at line 442 of file FeatureTrackerNode.cpp.
|
virtual |
Publish an image with the last feature locations and the predicted feature locations.
Definition at line 522 of file FeatureTrackerNode.cpp.
|
virtual |
Publish the mask of the predictions.
Definition at line 489 of file FeatureTrackerNode.cpp.
|
virtual |
Definition at line 414 of file FeatureTrackerNode.cpp.
|
virtual |
Publish an image with the last tracked features on it.
Definition at line 454 of file FeatureTrackerNode.cpp.
|
virtual |
Publish an image with the last tracked features together with the mask of the predictions.
Definition at line 465 of file FeatureTrackerNode.cpp.
|
virtual |
Publish the mask used to track features. Combines edges, predictions mask and max depth.
Definition at line 500 of file FeatureTrackerNode.cpp.
|
virtual |
Read messages from a rosbag instead of receiving them from a sensor Internally it "publishes" the messages that are then received by the measurement callback.
Definition at line 255 of file FeatureTrackerNode.cpp.
|
virtual |
Definition at line 533 of file FeatureTrackerNode.cpp.
|
virtual |
Reimplemented from omip::RecursiveEstimatorNodeInterface< ft_measurement_ros_t, ft_state_ros_t, FeatureTracker >.
Definition at line 826 of file FeatureTrackerNode.cpp.
|
virtual |
Callback for the predictions about the state of this RE level coming from the higher level of the hierarchy.
predicted_next_state | Predictions about the next state (next feature 3D locations) from the RBT |
Definition at line 222 of file FeatureTrackerNode.cpp.
|
protected |
Definition at line 339 of file FeatureTrackerNode.h.
|
protected |
Definition at line 344 of file FeatureTrackerNode.h.
|
protected |
Definition at line 338 of file FeatureTrackerNode.h.
|
protected |
Definition at line 341 of file FeatureTrackerNode.h.
|
protected |
Definition at line 342 of file FeatureTrackerNode.h.
|
protected |
Definition at line 314 of file FeatureTrackerNode.h.
|
protected |
Definition at line 260 of file FeatureTrackerNode.h.
|
protected |
Definition at line 323 of file FeatureTrackerNode.h.
|
protected |
Definition at line 261 of file FeatureTrackerNode.h.
|
protected |
Definition at line 259 of file FeatureTrackerNode.h.
|
protected |
Definition at line 285 of file FeatureTrackerNode.h.
|
protected |
Definition at line 266 of file FeatureTrackerNode.h.
|
protected |
Definition at line 267 of file FeatureTrackerNode.h.
|
protected |
Definition at line 299 of file FeatureTrackerNode.h.
|
protected |
Definition at line 328 of file FeatureTrackerNode.h.
|
protected |
Definition at line 292 of file FeatureTrackerNode.h.
|
protected |
Definition at line 294 of file FeatureTrackerNode.h.
|
protected |
Definition at line 293 of file FeatureTrackerNode.h.
|
protected |
Definition at line 297 of file FeatureTrackerNode.h.
|
protected |
Definition at line 279 of file FeatureTrackerNode.h.
|
protected |
Definition at line 275 of file FeatureTrackerNode.h.
|
protected |
Definition at line 252 of file FeatureTrackerNode.h.
|
protected |
Definition at line 325 of file FeatureTrackerNode.h.
|
protected |
Definition at line 282 of file FeatureTrackerNode.h.
|
protected |
Definition at line 336 of file FeatureTrackerNode.h.
|
protected |
Definition at line 335 of file FeatureTrackerNode.h.
|
protected |
Definition at line 320 of file FeatureTrackerNode.h.
|
protected |
Definition at line 288 of file FeatureTrackerNode.h.
|
protected |
Definition at line 265 of file FeatureTrackerNode.h.
|
protected |
Definition at line 251 of file FeatureTrackerNode.h.
|
protected |
Definition at line 324 of file FeatureTrackerNode.h.
|
protected |
Definition at line 248 of file FeatureTrackerNode.h.
|
protected |
Definition at line 331 of file FeatureTrackerNode.h.
|
protected |
Definition at line 255 of file FeatureTrackerNode.h.
|
protected |
Definition at line 317 of file FeatureTrackerNode.h.
|
protected |
Definition at line 256 of file FeatureTrackerNode.h.
|
protected |
Definition at line 327 of file FeatureTrackerNode.h.
|
protected |
Definition at line 312 of file FeatureTrackerNode.h.
|
protected |
Definition at line 272 of file FeatureTrackerNode.h.
|
protected |
Definition at line 283 of file FeatureTrackerNode.h.
|
protected |
Definition at line 289 of file FeatureTrackerNode.h.
|
protected |
Definition at line 329 of file FeatureTrackerNode.h.
|
protected |
Definition at line 280 of file FeatureTrackerNode.h.
|
protected |
Definition at line 318 of file FeatureTrackerNode.h.
|
protected |
Definition at line 300 of file FeatureTrackerNode.h.
|
protected |
Definition at line 302 of file FeatureTrackerNode.h.
|
protected |
Definition at line 308 of file FeatureTrackerNode.h.
|
protected |
Definition at line 305 of file FeatureTrackerNode.h.
|
protected |
Definition at line 309 of file FeatureTrackerNode.h.
|
protected |
Definition at line 306 of file FeatureTrackerNode.h.
|
protected |
Definition at line 301 of file FeatureTrackerNode.h.
|
protected |
Definition at line 303 of file FeatureTrackerNode.h.
|
protected |
Definition at line 304 of file FeatureTrackerNode.h.
|
protected |
Definition at line 307 of file FeatureTrackerNode.h.
|
protected |
Definition at line 310 of file FeatureTrackerNode.h.
|
protected |
Definition at line 276 of file FeatureTrackerNode.h.
|
protected |
Definition at line 253 of file FeatureTrackerNode.h.
|
protected |
Definition at line 326 of file FeatureTrackerNode.h.
|
protected |
Definition at line 316 of file FeatureTrackerNode.h.
|
protected |
Definition at line 262 of file FeatureTrackerNode.h.
|
protected |
Definition at line 298 of file FeatureTrackerNode.h.
|
protected |
Definition at line 254 of file FeatureTrackerNode.h.
|
protected |
Definition at line 268 of file FeatureTrackerNode.h.
|
protected |
Definition at line 270 of file FeatureTrackerNode.h.
|
protected |
Definition at line 277 of file FeatureTrackerNode.h.
|
protected |
Definition at line 278 of file FeatureTrackerNode.h.
|
protected |
Definition at line 322 of file FeatureTrackerNode.h.
|
protected |
Definition at line 281 of file FeatureTrackerNode.h.