hot patch to fix transform error in MPPI caused by #3425 (#3458)

(cherry picked from commit d429143)
ros-navigation · Mar 8, 2023 · a836502 · a836502
1 parent 7219d27
commit a836502
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