diff --git a/planning/behavior_velocity_planner/include/utilization/util.hpp b/planning/behavior_velocity_planner/include/utilization/util.hpp index 78ca80f15d12a..21d4ae947de43 100644 --- a/planning/behavior_velocity_planner/include/utilization/util.hpp +++ b/planning/behavior_velocity_planner/include/utilization/util.hpp @@ -149,6 +149,12 @@ double calcDist2d(const T1 & a, const T2 & b) return std::sqrt(calcSquaredDist2d(a, b)); } +template +double calcDist2d(const T & a, const T & b) +{ + return std::sqrt(calcSquaredDist2d(a, b)); +} + template bool calcClosestIndex( const T & path, const geometry_msgs::msg::Pose & pose, int & closest, double dist_thr = 3.0,