ouster_lidar.hpp

Go to the documentation of this file.

/*
 * SPDX-FileCopyrightText: 2020-2022 Smart Robotics Lab, Imperial College London, Technical University of Munich
 * SPDX-FileCopyrightText: 2020-2022 Nils Funk
 * SPDX-FileCopyrightText: 2020-2022 Sotiris Papatheodorou
 * SPDX-License-Identifier: BSD-3-Clause
 */
 
#ifndef SE_OUSTER_LIDAR_HPP
#define SE_OUSTER_LIDAR_HPP
 
 
 
namespace se {
 
class OusterLidar : public SensorBase<OusterLidar> {
    public:
    struct Config : public SensorBase<OusterLidar>::Config {
        Eigen::VectorXf beam_elevation_angles = Eigen::VectorXf(1);
 
        Eigen::VectorXf beam_azimuth_angles = Eigen::VectorXf(1);
 
        void readYaml(const std::string& filename);
 
        Config operator/(const float downsampling_factor) const;
 
        EIGEN_MAKE_ALIGNED_OPERATOR_NEW
    };
 
    OusterLidar(const Config& config);
 
    OusterLidar(const Config& config, const float downsampling_factor);
 
    OusterLidar(const OusterLidar& ouster_lidar, const float downsampling_factor);
 
    Eigen::Matrix3f K() const
    {
        return Eigen::Matrix3f::Zero();
    }
 
    int computeIntegrationScaleImpl(const Eigen::Vector3f& block_centre,
                                    const float map_res,
                                    const int last_scale,
                                    const int min_scale,
                                    const int max_block_scale) const;
 
    float nearDistImpl(const Eigen::Vector3f& ray_S) const;
 
    float farDistImpl(const Eigen::Vector3f& ray_S) const;
 
    float measurementFromPointImpl(const Eigen::Vector3f& point_S) const;
 
    bool pointInFrustumImpl(const Eigen::Vector3f& point_S) const;
 
    bool pointInFrustumInfImpl(const Eigen::Vector3f& point_S) const;
 
    bool sphereInFrustumImpl(const Eigen::Vector3f& centre_S, const float radius) const;
 
    bool sphereInFrustumInfImpl(const Eigen::Vector3f& centre_S, const float radius) const;
 
    static std::string typeImpl();
 
    srl::projection::OusterLidar model;
    float min_ray_angle;
 
    float min_elevation_rad;
    float max_elevation_rad;
 
    float horizontal_fov;
    float vertical_fov;
 
    EIGEN_MAKE_ALIGNED_OPERATOR_NEW
};
 
std::ostream& operator<<(std::ostream& os, const OusterLidar::Config& c);
 
} // namespace se
 
#include "impl/ouster_lidar_impl.hpp"
 
#endif // SE_OUSTER_LIDAR_HPP