diff --git a/planning/behavior_velocity_planner/autoware_behavior_velocity_run_out_module/src/utils.cpp b/planning/behavior_velocity_planner/autoware_behavior_velocity_run_out_module/src/utils.cpp index 4f03dadc0555a..151d2616da5f9 100644 --- a/planning/behavior_velocity_planner/autoware_behavior_velocity_run_out_module/src/utils.cpp +++ b/planning/behavior_velocity_planner/autoware_behavior_velocity_run_out_module/src/utils.cpp @@ -134,20 +134,6 @@ bool isSamePoint(const geometry_msgs::msg::Point & p1, const geometry_msgs::msg: return false; } -// if path points have the same point as target_point, return the index -std::optional haveSamePoint( - const PathPointsWithLaneId & path_points, const geometry_msgs::msg::Point & target_point) -{ - for (size_t i = 0; i < path_points.size(); i++) { - const auto & path_point = path_points.at(i).point.pose.position; - if (isSamePoint(path_point, target_point)) { - return i; - } - } - - return {}; -} - // insert path velocity which doesn't exceed original velocity void insertPathVelocityFromIndexLimited( const size_t & start_idx, const float velocity_mps, PathPointsWithLaneId & path_points) diff --git a/planning/behavior_velocity_planner/autoware_behavior_velocity_run_out_module/src/utils.hpp b/planning/behavior_velocity_planner/autoware_behavior_velocity_run_out_module/src/utils.hpp index f96d9f966265f..af6d9a7bc631b 100644 --- a/planning/behavior_velocity_planner/autoware_behavior_velocity_run_out_module/src/utils.hpp +++ b/planning/behavior_velocity_planner/autoware_behavior_velocity_run_out_module/src/utils.hpp @@ -224,10 +224,6 @@ std::vector findLateralSameSidePoints( bool isSamePoint(const geometry_msgs::msg::Point & p1, const geometry_msgs::msg::Point & p2); -// if path points have the same point as target_point, return the index -std::optional haveSamePoint( - const PathPointsWithLaneId & path_points, const geometry_msgs::msg::Point & target_point); - // insert path velocity which doesn't exceed original velocity void insertPathVelocityFromIndexLimited( const size_t & start_idx, const float velocity_mps, PathPointsWithLaneId & path_points);