Merge pull request #45 from purduesigbots/AddHelperFunction

add getDistance in Point struct
purduesigbots · Jan 29, 2024 · 6104033 · 6104033
2 parents e7df2b1 + 451d9ea
commit 6104033
Showing 1 changed file with 7 additions and 0 deletions.
diff --git a/include/VOSS/utils/Point.hpp b/include/VOSS/utils/Point.hpp
@@ -1,10 +1,17 @@
 #pragma once
+#include <cmath>
 
 namespace voss {
 
 struct Point {
     double x;
     double y;
+
+    static double getDistance(Point a, Point b) {
+        double dx = a.x - b.x;
+        double dy = a.y - b.y;
+        return sqrt(dx * dx + dy * dy);
+    }
 };
 
 } // namespace voss