Update theta_star_planner.cpp (ros-navigation#3918)

Signed-off-by: gg <[email protected]>
jwallace42 · Jan 3, 2024 · b3dc640 · b3dc640
1 parent dbf38c1
commit b3dc640
Showing 1 changed file with 2 additions and 0 deletions.
diff --git a/nav2_theta_star_planner/src/theta_star_planner.cpp b/nav2_theta_star_planner/src/theta_star_planner.cpp
@@ -91,6 +91,8 @@ nav_msgs::msg::Path ThetaStarPlanner::createPlan(
   nav_msgs::msg::Path global_path;
   auto start_time = std::chrono::steady_clock::now();
 
+  std::unique_lock<nav2_costmap_2d::Costmap2D::mutex_t> lock(*(planner_->costmap_->getMutex()));
+
   // Corner case of start and goal beeing on the same cell
   unsigned int mx_start, my_start, mx_goal, my_goal;
   if (!planner_->costmap_->worldToMap(