Skip to content

Commit

Permalink
fix(bpp): prevent accessing nullopt (autowarefoundation#9204) (#1618)
Browse files Browse the repository at this point in the history
fix(bpp): calcDistanceToRedTrafficLight null

Signed-off-by: Shumpei Wakabayashi <[email protected]>
  • Loading branch information
shmpwk authored Nov 1, 2024
1 parent 9219335 commit b5cc639
Showing 1 changed file with 1 addition and 0 deletions.
Original file line number Diff line number Diff line change
Expand Up @@ -98,6 +98,7 @@ std::optional<double> calcDistanceToRedTrafficLight(

const auto & ego_pos = planner_data->self_odometry->pose.pose.position;
lanelet::ConstLineString3d stop_line = *(element->stopLine());
if (!stop_line.empty()) return std::nullopt;
const auto x = 0.5 * (stop_line.front().x() + stop_line.back().x());
const auto y = 0.5 * (stop_line.front().y() + stop_line.back().y());
const auto z = 0.5 * (stop_line.front().z() + stop_line.back().z());
Expand Down

0 comments on commit b5cc639

Please sign in to comment.