Humble: nav2_navfn_planner poses created had uninitialized header (#5087)

* added disengage_threshold

* added global costmap clearing once it reaches goal

* fixed merge error in rotaton_shim_controller

* fixed pose header frame_id in nav2_navfn_planner

* reverted change to nav2_bt_navigator/behavior_trees/navigate_to_pose_w_replanning_and_recovery.xml

* one more spot for the header update

Author: sandeepdutta

nav2_navfn_planner/src/navfn_planner.cpp

@@ -363,6 +363,7 @@ NavfnPlanner::smoothApproachToGoal(
   }
   geometry_msgs::msg::PoseStamped goal_copy;
   goal_copy.pose = goal;
+  goal_copy.header = plan.header;
   plan.poses.push_back(goal_copy);
 }
 
@@ -418,6 +419,7 @@ NavfnPlanner::getPlanFromPotential(
     mapToWorld(x[i], y[i], world_x, world_y);
 
     geometry_msgs::msg::PoseStamped pose;
+    pose.header = plan.header;
     pose.pose.position.x = world_x;
     pose.pose.position.y = world_y;
     pose.pose.position.z = 0.0;