Publish the right template

Signed-off-by: Alberto Tudela <ajtudela@gmail.com>
grupo-avispa · Jul 2, 2024 · 677b5b3 · 677b5b3
1 parent c4c5270
commit 677b5b3
Showing 1 changed file with 1 addition and 1 deletion.
diff --git a/scitos2_charging_dock/src/perception.cpp b/scitos2_charging_dock/src/perception.cpp
@@ -307,7 +307,7 @@ bool Perception::refineAllClustersPoses(
     if (debug_) {
       // Publish dock template
       sensor_msgs::msg::PointCloud2 template_msg;
-      pcl::toROSMsg(*cloud_template, template_msg);
+      pcl::toROSMsg(*cloud_template_initial, template_msg);
       template_msg.header.frame_id = initial_estimate_pose_.header.frame_id;
       template_msg.header.stamp = clock_->now();
       dock_template_pub_->publish(std::move(template_msg));