Add point-box distance

libs/geom/include/psemek/geom/distance.hpp

@@ -0,0 +1,24 @@
+#pragma once
+
+#include <psemek/geom/point.hpp>
+#include <psemek/geom/box.hpp>
+#include <psemek/geom/math.hpp>
+
+namespace psemek::geom
+{
+
+	template <typename T, std::size_t N>
+	T distance(point<T, N> const & p, box<T, N> const & b)
+	{
+		T s = T{};
+		for (std::size_t i = 0; i < N; ++i)
+		{
+			if (p[i] < b[i].min)
+				s += sqr(b[i].min - p[i]);
+			else if (p[i] > b[i].max)
+				s += sqr(p[i] - b[i].max);
+		}
+		return std::sqrt(s);
+	}
+
+}