feat(blind_spot): consider road_shoulder if exist (#1411)

PR7925相当の変更 Signed-off-by: Mamoru Sobue <[email protected]> Co-authored-by: Mamoru Sobue <[email protected]>
tier4 · Jul 12, 2024 · cd1e5db · cd1e5db
1 parent cf4a195
commit cd1e5db
Showing 1 changed file with 7 additions and 0 deletions.
diff --git a/planning/behavior_velocity_blind_spot_module/src/scene.cpp b/planning/behavior_velocity_blind_spot_module/src/scene.cpp
@@ -550,6 +550,13 @@ std::optional<BlindSpotPolygons> BlindSpotModule::generateBlindSpotPolygons(
       if (adj_lane) {
         return *adj_lane;
       }
+      const auto assoc_shoulder =
+        (turn_direction_ == TurnDirection::LEFT)
+          ? planner_data_->route_handler_->getLeftLanelet(lane, true /* get_shoulder_lane */)
+          : planner_data_->route_handler_->getRightLanelet(lane, true);
+      if (assoc_shoulder) {
+        return assoc_shoulder.value();
+      }
 
       return std::nullopt;
     });