Skip to content

Commit

Permalink
Support QoS override parameters in depth_image_proc/register (#1043)
Browse files Browse the repository at this point in the history
This PR adds support to the `depth_image_proc` - `register` node for
setting External QoS Configuration on topic _subscriptions_.
  • Loading branch information
skalldri authored Nov 25, 2024
1 parent d7d992f commit 0dd99bf
Showing 1 changed file with 8 additions and 3 deletions.
11 changes: 8 additions & 3 deletions depth_image_proc/src/register.cpp
Original file line number Diff line number Diff line change
Expand Up @@ -133,14 +133,19 @@ RegisterNode::RegisterNode(const rclcpp::NodeOptions & options)
sub_depth_info_.unsubscribe();
sub_rgb_info_.unsubscribe();
} else if (!sub_depth_image_.getSubscriber()) {
// Allow overriding QoS settings (history, depth, reliability)
rclcpp::SubscriptionOptions sub_options;
sub_options.qos_overriding_options = rclcpp::QosOverridingOptions::with_default_policies();

// For compressed topics to remap appropriately, we need to pass a
// fully expanded and remapped topic name to image_transport
auto node_base = this->get_node_base_interface();
std::string topic = node_base->resolve_topic_or_service_name("depth/image_rect", false);
image_transport::TransportHints hints(this, "raw", "depth_image_transport");
sub_depth_image_.subscribe(this, topic, hints.getTransport());
sub_depth_info_.subscribe(this, "depth/camera_info", rclcpp::QoS(10));
sub_rgb_info_.subscribe(this, "rgb/camera_info", rclcpp::QoS(10));
sub_depth_image_.subscribe(this, topic, hints.getTransport(), rmw_qos_profile_default,
sub_options);
sub_depth_info_.subscribe(this, "depth/camera_info", rclcpp::QoS(10), sub_options);
sub_rgb_info_.subscribe(this, "rgb/camera_info", rclcpp::QoS(10), sub_options);
}
};
// For compressed topics to remap appropriately, we need to pass a
Expand Down

0 comments on commit 0dd99bf

Please sign in to comment.