diff --git a/nav2_docking/opennav_docking/src/simple_charging_dock.cpp b/nav2_docking/opennav_docking/src/simple_charging_dock.cpp index b00e48b13cc..adc5940fd2a 100644 --- a/nav2_docking/opennav_docking/src/simple_charging_dock.cpp +++ b/nav2_docking/opennav_docking/src/simple_charging_dock.cpp @@ -152,10 +152,12 @@ void SimpleChargingDock::configure( nav2::qos::StandardTopicQoS()); } - dock_pose_pub_ = node_->create_publisher("dock_pose"); + dock_pose_pub_ = node_->create_publisher( + "dock_pose", nav2::qos::LatchedPublisherQoS()); filtered_dock_pose_pub_ = node_->create_publisher( - "filtered_dock_pose"); - staging_pose_pub_ = node_->create_publisher("staging_pose"); + "filtered_dock_pose", nav2::qos::LatchedPublisherQoS()); + staging_pose_pub_ = node_->create_publisher( + "staging_pose", nav2::qos::LatchedPublisherQoS()); } geometry_msgs::msg::PoseStamped SimpleChargingDock::getStagingPose( diff --git a/nav2_docking/opennav_docking/src/simple_non_charging_dock.cpp b/nav2_docking/opennav_docking/src/simple_non_charging_dock.cpp index 9977b091793..c7289e0f05f 100644 --- a/nav2_docking/opennav_docking/src/simple_non_charging_dock.cpp +++ b/nav2_docking/opennav_docking/src/simple_non_charging_dock.cpp @@ -135,10 +135,12 @@ void SimpleNonChargingDock::configure( nav2::qos::StandardTopicQoS()); } - dock_pose_pub_ = node_->create_publisher("dock_pose"); + dock_pose_pub_ = node_->create_publisher( + "dock_pose", nav2::qos::LatchedPublisherQoS()); filtered_dock_pose_pub_ = node_->create_publisher( - "filtered_dock_pose"); - staging_pose_pub_ = node_->create_publisher("staging_pose"); + "filtered_dock_pose", nav2::qos::LatchedPublisherQoS()); + staging_pose_pub_ = node_->create_publisher( + "staging_pose", nav2::qos::LatchedPublisherQoS()); } geometry_msgs::msg::PoseStamped SimpleNonChargingDock::getStagingPose(