From 4d56340e734f247090c01021b1908e0fded2f066 Mon Sep 17 00:00:00 2001
From: Christof Dubs <christof.dubs@gmx.ch>
Date: Tue, 31 Jan 2023 12:42:43 +0900
Subject: [PATCH] use hypot

---
 global_planner/include/global_planner/planner_core.h | 2 +-
 1 file changed, 1 insertion(+), 1 deletion(-)

diff --git a/global_planner/include/global_planner/planner_core.h b/global_planner/include/global_planner/planner_core.h
index 4ae3de26f5..5b0cdcbc65 100644
--- a/global_planner/include/global_planner/planner_core.h
+++ b/global_planner/include/global_planner/planner_core.h
@@ -192,7 +192,7 @@ class GlobalPlanner : public mbf_costmap_core::CostmapPlanner {
         inline double sq_distance(const geometry_msgs::PoseStamped& p1, const geometry_msgs::PoseStamped& p2){
           double dx = p1.pose.position.x - p2.pose.position.x;
           double dy = p1.pose.position.y - p2.pose.position.y;
-          return dx*dx + dy*dy;
+          return std::hypot(dx, dy);
         }
         void mapToWorld(double mx, double my, double& wx, double& wy);
         bool worldToMap(double wx, double wy, double& mx, double& my);