diff --git a/nav2_navfn_planner/src/navfn_planner.cpp b/nav2_navfn_planner/src/navfn_planner.cpp index 739ede3aa4f1d46524eafb848bfe3338d982a9ea..91d7fffb7181794582488ed519dcb3addac15919 100644 --- a/nav2_navfn_planner/src/navfn_planner.cpp +++ b/nav2_navfn_planner/src/navfn_planner.cpp @@ -163,6 +163,7 @@ NavfnPlanner::computePathToPose(const std::shared_ptr<GoalHandle> goal_handle) try { // Get the current pose from the robot + getCostmap(costmap_); auto start = std::make_shared<geometry_msgs::msg::PoseWithCovarianceStamped>(); if (!robot_->getCurrentPose(start)) {