Add geom::signed_distance
This commit is contained in:
parent
a397a21628
commit
ec86b0c0aa
1 changed files with 19 additions and 0 deletions
|
|
@ -5,6 +5,7 @@
|
||||||
#include <psemek/geom/math.hpp>
|
#include <psemek/geom/math.hpp>
|
||||||
#include <psemek/geom/simplex.hpp>
|
#include <psemek/geom/simplex.hpp>
|
||||||
#include <psemek/geom/gauss.hpp>
|
#include <psemek/geom/gauss.hpp>
|
||||||
|
#include <psemek/geom/contains.hpp>
|
||||||
|
|
||||||
namespace psemek::geom
|
namespace psemek::geom
|
||||||
{
|
{
|
||||||
|
|
@ -17,6 +18,12 @@ namespace psemek::geom
|
||||||
return std::min(std::abs(x - i.min), std::abs(x - i.max));
|
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>
|
template <typename T, std::size_t N>
|
||||||
T distance(point<T, N> const & p, box<T, N> const & b)
|
T distance(point<T, N> const & p, box<T, N> const & b)
|
||||||
{
|
{
|
||||||
|
|
@ -31,6 +38,18 @@ namespace psemek::geom
|
||||||
return std::sqrt(s);
|
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>
|
template <typename T, std::size_t N>
|
||||||
T distance(point<T, N> const & p, segment<point<T, N>> const & s)
|
T distance(point<T, N> const & p, segment<point<T, N>> const & s)
|
||||||
{
|
{
|
||||||
|
|
|
||||||
Loading…
Add table
Reference in a new issue