From 42561ccadb93ca947a3d668d7747dc1dc33cf01c Mon Sep 17 00:00:00 2001
From: lisyarus <lisyarus@gmail.com>
Date: Wed, 21 Oct 2020 22:26:41 +0300
Subject: [PATCH] Add distance(point,segment)

---
 libs/geom/include/psemek/geom/simplex.hpp | 11 +++++++++++
 1 file changed, 11 insertions(+)

diff --git a/libs/geom/include/psemek/geom/simplex.hpp b/libs/geom/include/psemek/geom/simplex.hpp
index 39483864..3ff6b1a9 100644
--- a/libs/geom/include/psemek/geom/simplex.hpp
+++ b/libs/geom/include/psemek/geom/simplex.hpp
@@ -43,4 +43,15 @@ namespace psemek::geom
 		return os << ')';
 	}
 
+	template <typename T, std::size_t N>
+	T distance(point<T, N> const & p, segment<point<T, N>> const & s)
+	{
+		T const t = dot(p - s[0], s[1] - s[0]) / length_sqr(s[1] - s[0]);
+
+		if (t >= 0 && t <= 1)
+			return distance(p, lerp(s[0], s[1], t));
+
+		return std::min(distance(p, s[0]), distance(p, s[1]));
+	}
+
 }