planner_cspace: reset next_replan_time after waitUntil() (#602)

at-wat · Jun 21, 2021 · 0323740 · 0323740
1 parent d257671
commit 0323740
Showing 1 changed file with 1 addition and 0 deletions.
diff --git a/planner_cspace/src/planner_3d.cpp b/planner_cspace/src/planner_3d.cpp
@@ -1470,6 +1470,7 @@ class Planner3dNode
       waitUntil(next_replan_time, previous_path);
 
       const ros::Time now = ros::Time::now();
+      next_replan_time = now;
 
       if (has_map_ && !goal_updated_ && has_goal_)
       {