added another version for calcDist2d

Signed-off-by: Mamoru Sobue <mamoru.sobue@tier4.jp>
autowarefoundation · Jul 29, 2022 · cf11b5d · cf11b5d
1 parent 2eda5fb
commit cf11b5d
Showing 1 changed file with 6 additions and 0 deletions.
diff --git 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<T1, T2>(a, b));
 }
 
+template <class T>
+double calcDist2d(const T & a, const T & b)
+{
+  return std::sqrt(calcSquaredDist2d<T, T>(a, b));
+}
+
 template <class T>
 bool calcClosestIndex(
   const T & path, const geometry_msgs::msg::Pose & pose, int & closest, double dist_thr = 3.0,