Skip to content

Commit

Permalink
fix(obstacle_avoidance_planner): guard trajectory size (autowarefound…
Browse files Browse the repository at this point in the history
…ation#292)

Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com>
  • Loading branch information
takayuki5168 committed Feb 28, 2023
1 parent 6b2bdd7 commit 9e5d81b
Showing 1 changed file with 1 addition and 1 deletion.
2 changes: 1 addition & 1 deletion planning/obstacle_avoidance_planner/src/node.cpp
Original file line number Diff line number Diff line change
Expand Up @@ -1412,7 +1412,7 @@ ObstacleAvoidancePlanner::alignVelocity(
-> std::pair<
std::vector<autoware_auto_planning_msgs::msg::TrajectoryPoint>, boost::optional<size_t>> {
const auto opt_path_zero_vel_idx = tier4_autoware_utils::searchZeroVelocityIndex(path_points);
if (opt_path_zero_vel_idx) {
if (opt_path_zero_vel_idx && 1 < fine_traj_points.size()) {
const auto & zero_vel_path_point = path_points.at(opt_path_zero_vel_idx.get());
const auto opt_traj_seg_idx = tier4_autoware_utils::findNearestSegmentIndex(
fine_traj_points, zero_vel_path_point.pose, std::numeric_limits<double>::max(),
Expand Down

0 comments on commit 9e5d81b

Please sign in to comment.