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_