40 #ifndef THREE_DIMENSIONAL_LIDAR_FRUSTUM_H_ 41 #define THREE_DIMENSIONAL_LIDAR_FRUSTUM_H_ 56 const double& hFOV,
const double& min_dist,
const double& max_dist);
63 virtual bool IsInside(
const openvdb::Vec3d& pt);
66 virtual void SetPosition(
const geometry_msgs::Point& origin);
67 virtual void SetOrientation(
const geometry_msgs::Quaternion& quat);
ThreeDimensionalLidarFrustum(const double &vFOV, const double &vFOVPadding, const double &hFOV, const double &min_dist, const double &max_dist)
double Dot(const VectorWithPt3D &, const openvdb::Vec3d &) const
virtual void SetPosition(const geometry_msgs::Point &origin)
Eigen::Vector3d _position
Eigen::Quaterniond _orientation
double _tan_vFOVhalf_squared
virtual bool IsInside(const openvdb::Vec3d &pt)
virtual void TransformModel(void)
virtual void SetOrientation(const geometry_msgs::Quaternion &quat)
virtual ~ThreeDimensionalLidarFrustum(void)
Eigen::Quaterniond _orientation_conjugate