| 328 | |
| 329 | template <class PointCloud> |
| 330 | void filterminDistance(PointCloud& cloud, ufo::Point origin, float min_distance) |
| 331 | { |
| 332 | float sqrt_dist = min_distance * min_distance; |
| 333 | std::erase_if(cloud, [origin, sqrt_dist](auto const& point) { |
| 334 | return origin.squaredDistance(point) < sqrt_dist; |
| 335 | }); |
| 336 | } |
| 337 | |
| 338 | int main(int argc, char* argv[]) |
| 339 | { |