lidar_imager_node.hpp

Go to the documentation of this file.

// Original Author of FLOAM: Wang Han 
// Email wh200720041@gmail.com
// Homepage https://wanghan.pro
#ifndef FLOAM__LIDAR_IMAGER_NODE_HPP_
#define FLOAM__LIDAR_IMAGER_NODE_HPP_

#include <ros/ros.h>
#include <nodelet/nodelet.h>
#include <sensor_msgs/PointCloud2.h>

#include <pcl_conversions/pcl_conversions.h>
#include <pcl/point_cloud.h>
#include <pcl/point_types.h>

#include "floam/lidar.hpp"
#include "floam/lidar_utils.hpp"


namespace floam
{
namespace lidar
{


class ImagingLidarNode : public nodelet::Nodelet
{
public:
  ImagingLidarNode();
  ~ImagingLidarNode();

  void onInit();

  void handlePoints(const sensor_msgs::PointCloud2ConstPtr &lidarCloudMsg);

  Lidar<floam::lidar::Imager> m_lidar;

private:
  ros::NodeHandle m_nodeHandle;

  ros::Subscriber m_subPoints;

  ros::Publisher m_pubEdgePoints;
  ros::Publisher m_pubSurfacePoints;
  ros::Publisher m_pubPointsFiltered;

  std::queue<sensor_msgs::PointCloud2ConstPtr> m_points;

};

}  // namespace lidar
}  // namespace floam

#endif  // FLOAM__LIDAR_IMAGER_NODE_HPP_