small modification

Signed-off-by: Takumi Ito <takumi.ito@tier4.jp>

Author: Takumi Ito

planning/autoware_freespace_planning_algorithms/src/astar_search.cpp

@@ -131,7 +131,6 @@ void AstarSearch::setMap(const nav_msgs::msg::OccupancyGrid & costmap)
   AbstractPlanningAlgorithm::setMap(costmap);
 
   x_scale_ = costmap_.info.height;
-  graph_.reserve(100000);
 }
 
 bool AstarSearch::makePlan(
@@ -141,6 +140,7 @@ bool AstarSearch::makePlan(
   goal_pose_ = global2local(costmap_, goal_pose);
 
   clearNodes();
+  graph_.reserve(100000);
 
   if (!setStartNode()) {
     return false;