refactor(behavior_velocity_planner): remove unused "findEgoIndex" (#3256

) Signed-off-by: Maxime CLEMENT <maxime.clement@tier4.jp>
autowarefoundation · Apr 4, 2023 · 25c154d · 25c154d
1 parent c705f49
commit 25c154d
Showing 1 changed file with 0 additions and 19 deletions.
diff --git a/planning/behavior_velocity_planner/include/scene_module/scene_module_interface.hpp b/planning/behavior_velocity_planner/include/scene_module/scene_module_interface.hpp
@@ -129,15 +129,6 @@ class SceneModuleInterface
       points, p->current_odometry->pose, p->ego_nearest_dist_threshold,
       p->ego_nearest_yaw_threshold);
   }
-
-  template <class T>
-  size_t findEgoIndex(const std::vector<T> & points) const
-  {
-    const auto & p = planner_data_;
-    return motion_utils::findFirstNearestIndexWithSoftConstraints(
-      points, p->current_odometry->pose, p->ego_nearest_dist_threshold,
-      p->ego_nearest_yaw_threshold);
-  }
 };
 
 class SceneModuleManagerInterface
@@ -310,16 +301,6 @@ class SceneModuleManagerInterface
       p->ego_nearest_yaw_threshold);
   }
 
-  template <class T>
-  size_t findEgoIndex(
-    const std::vector<T> & points, const geometry_msgs::msg::Pose & ego_pose) const
-  {
-    const auto & p = planner_data_;
-    return motion_utils::findFirstNearestIndexWithSoftConstraints(
-      points, p->current_odometry->pose, p->ego_nearest_dist_threshold,
-      p->ego_nearest_yaw_threshold);
-  }
-
   std::set<std::shared_ptr<SceneModuleInterface>> scene_modules_;
   std::set<int64_t> registered_module_id_set_;