Add geom::signed_distance

This commit is contained in:
Nikita Lisitsa 2021-12-01 21:22:00 +03:00
parent a397a21628
commit ec86b0c0aa

View file

@ -5,6 +5,7 @@
#include <psemek/geom/math.hpp>
#include <psemek/geom/simplex.hpp>
#include <psemek/geom/gauss.hpp>
#include <psemek/geom/contains.hpp>
namespace psemek::geom
{
@ -17,6 +18,12 @@ namespace psemek::geom
return std::min(std::abs(x - i.min), std::abs(x - i.max));
}
template <typename T>
T signed_distance(T const & x, interval<T> const & i)
{
return std::max(i.min - x, x - i.max);
}
template <typename T, std::size_t N>
T distance(point<T, N> const & p, box<T, N> const & b)
{
@ -31,6 +38,18 @@ namespace psemek::geom
return std::sqrt(s);
}
template <typename T, std::size_t N>
T signed_distance(point<T, N> const & p, box<T, N> const & b)
{
if (!contains(b, p))
return distance(p, b);
T s = limits<T>::min();
for (std::size_t i = 0; i < N; ++i)
s = std::max(s, signed_distance(p[i], b[i]));
return s;
}
template <typename T, std::size_t N>
T distance(point<T, N> const & p, segment<point<T, N>> const & s)
{