From cf11b5d085ec4b0ec091512ba6aa7feb8a92305c Mon Sep 17 00:00:00 2001
From: Mamoru Sobue <mamoru.sobue@tier4.jp>
Date: Fri, 29 Jul 2022 11:21:42 +0900
Subject: [PATCH] added another version for calcDist2d

Signed-off-by: Mamoru Sobue <mamoru.sobue@tier4.jp>
---
 .../behavior_velocity_planner/include/utilization/util.hpp  | 6 ++++++
 1 file changed, 6 insertions(+)

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<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,