hot patch to fix transform error in MPPI caused by ros-navigation#3425 (

ros-navigation#3458)
alyquantillion · Mar 8, 2023 · d429143 · d429143
1 parent 34f18d9
commit d429143
Showing 1 changed file with 1 addition and 0 deletions.
diff --git a/nav2_mppi_controller/src/path_handler.cpp b/nav2_mppi_controller/src/path_handler.cpp
@@ -75,6 +75,7 @@ PathHandler::getGlobalPlanConsideringBoundsInCostmapFrame(
     // Transform from global plan frame to costmap frame
     geometry_msgs::msg::PoseStamped costmap_plan_pose;
     global_plan_pose->header.stamp = global_pose.header.stamp;
+    global_plan_pose->header.frame_id = global_plan_.header.frame_id;
     transformPose(costmap_->getGlobalFrameID(), *global_plan_pose, costmap_plan_pose);
 
     // Check if pose is inside the costmap