add WaypointSequence missing header

mrpt-ros-pkg · Jul 24, 2024 · d25f912 · d25f912 · jlblancoc · Jul 24, 2024
1 parent 84ce088
commit d25f912
Showing 1 changed file with 3 additions and 0 deletions.
diff --git a/mrpt_tps_astar_planner/src/mrpt_tps_astar_planner_node.cpp b/mrpt_tps_astar_planner/src/mrpt_tps_astar_planner_node.cpp
@@ -832,6 +832,9 @@ mpp::refine_trajectory(plannedPath, pathEdges, planner_input.ptgs);
 		wp_msg.allow_skip = false;
 
 		res.wps.waypoints.push_back(wp_msg);
+
+		res.wps.header.frame_id = frame_id_map_;
+		res.wps.header.stamp = this->now();
 	}
 
 	return res;