diff --git a/libs/geom/include/psemek/geom/distance.hpp b/libs/geom/include/psemek/geom/distance.hpp index d283aa21..eb33f94e 100644 --- a/libs/geom/include/psemek/geom/distance.hpp +++ b/libs/geom/include/psemek/geom/distance.hpp @@ -9,6 +9,14 @@ namespace psemek::geom { + template + T distance(T const & x, interval const & i) + { + if (i.min <= x && x <= i.max) + return T{0}; + return std::min(std::abs(x - i.min), std::abs(x - i.max)); + } + template T distance(point const & p, box const & b) {