nerdcruft/libcruft-util
1
0
Fork 0
Code Issues Releases Activity

geom/plane: add furthest point finder

Browse Source
This commit is contained in:
Danny Robson 2018-04-23 15:41:58 +10:00
parent 87dda1c568
commit 6290f0be93
1 changed files with 23 additions and 0 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

23
geom/plane.hpp
View File

@ -94,4 +94,27 @@ namespace util::geom {
{
return -distance (q, p);
}
///////////////////////////////////////////////////////////////////////////
template <size_t S, typename T>
auto
furthest (plane<S,T> p, const std::vector<util::point<S,T>> &cloud)
{
T maxd = -INFINITY;
auto best = cloud.begin ();
for (auto q = cloud.begin (), last = cloud.end (); q != last; ++q) {
if (auto d = distance (p, *q); d > maxd) {
maxd = d;
best = q;
}
}
return std::make_tuple (best, maxd);
}
template <size_t S, typename T>
auto
furthest (plane<S,T>, std::vector<util::point<S,T>> &&) = delete;
}