fix(obsacle_avoidance_planner): resetting stop pose by drivable area …

…when AW is able to recover from footprint out of drivable area (to clear the polygon)

Signed-off-by: AhmedEbrahim <ahmed.a.d.ebrahim@gmail.com>

planning/obstacle_avoidance_planner/src/node.cpp

@@ -450,6 +450,8 @@ void ObstacleAvoidancePlanner::insertZeroVelocityOutsideDrivableArea(
     for (size_t i = *first_outside_idx; i < optimized_traj_points.size(); ++i) {
       optimized_traj_points.at(i).longitudinal_velocity_mps = 0.0;
     }
+  } else {
+    debug_data_ptr_->stop_pose_by_drivable_area = boost::none;
   }
 
   time_keeper_ptr_->toc(__func__, "    ");