Class VoxelHashMap

Class Documentation

class VoxelHashMap

Public Functions

explicit VoxelHashMap(const Scalar voxel_size, const Scalar clipping_distance)
inline void clear()
inline bool empty() const
void update(const std::vector<Eigen::Vector3s> &points, const Sophus::SE3s &pose)
void add_points(const std::vector<Eigen::Vector3s> &points, const Sophus::SE3s &pose)
void remove_points_far_from_location(const Eigen::Vector3s &location)
std::vector<Eigen::Vector3s> points() const
std::optional<Eigen::Vector3s> get_closest_neighbor(const Eigen::Vector3s &query, const Scalar max_distance) const

Nearest point to query strictly within max_distance, or nullopt if there is none.