Skip to content
Snippets Groups Projects
Commit 66924b09 authored by Tom Fischer's avatar Tom Fischer
Browse files

[GL/Grid] Subst. lambda by using Point3d::asEigenVecto3d().

parent 9012660f
No related branches found
No related tags found
No related merge requests found
...@@ -651,15 +651,14 @@ bool Grid<POINT>::calcNearestPointInGridCell( ...@@ -651,15 +651,14 @@ bool Grid<POINT>::calcNearestPointInGridCell(
if (pnts.empty()) if (pnts.empty())
return false; return false;
auto const to_eigen = [](auto const& p) { return (p.asEigenVector3d()); };
const std::size_t n_pnts(pnts.size()); const std::size_t n_pnts(pnts.size());
sqr_min_dist = (to_eigen(*pnts[0]) - to_eigen(pnt)).squaredNorm(); sqr_min_dist =
(pnts[0]->asEigenVector3d() - pnt.asEigenVector3d()).squaredNorm();
nearest_pnt = pnts[0]; nearest_pnt = pnts[0];
for (std::size_t i(1); i < n_pnts; i++) for (std::size_t i(1); i < n_pnts; i++)
{ {
const double sqr_dist( const double sqr_dist(
(to_eigen(*pnts[i]) - to_eigen(pnt)).squaredNorm()); (pnts[i]->asEigenVector3d() - pnt.asEigenVector3d()).squaredNorm());
if (sqr_dist < sqr_min_dist) if (sqr_dist < sqr_min_dist)
{ {
sqr_min_dist = sqr_dist; sqr_min_dist = sqr_dist;
...@@ -679,15 +678,13 @@ std::vector<std::size_t> Grid<POINT>::getPointsInEpsilonEnvironment( ...@@ -679,15 +678,13 @@ std::vector<std::size_t> Grid<POINT>::getPointsInEpsilonEnvironment(
double const sqr_eps(eps * eps); double const sqr_eps(eps * eps);
auto to_eigen = [](auto const& point)
{ return Eigen::Map<Eigen::Vector3d const>(point.data()); };
std::vector<std::size_t> pnts; std::vector<std::size_t> pnts;
for (auto vec : vec_pnts) for (auto vec : vec_pnts)
{ {
for (auto const p : *vec) for (auto const p : *vec)
{ {
if ((to_eigen(*p) - to_eigen(pnt)).squaredNorm() <= sqr_eps) if ((p->asEigenVector3d() - pnt.asEigenVector3d()).squaredNorm() <=
sqr_eps)
{ {
pnts.push_back(p->getID()); pnts.push_back(p->getID());
} }
......
0% Loading or .
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment