pf_data_publisher.h

Go to the documentation of this file.

#pragma once
 
#include <deque>
#include <mutex>
 
#include <ros/ros.h>
#include <sensor_msgs/LaserScan.h>
 
#include "pf_driver/pf/pf_packet_reader.h"
 
class PFDataPublisher : public PFPacketReader
{
public:
  PFDataPublisher(std::shared_ptr<ScanConfig> config, std::shared_ptr<ScanParameters> params);
 
  virtual void read(PFR2000Packet_A& packet);
  virtual void read(PFR2000Packet_B& packet);
  virtual void read(PFR2000Packet_C& packet);
  virtual void read(PFR2300Packet_C1& packet);
 
  virtual bool start();
 
  virtual bool stop();
 
protected:
  ros::NodeHandle nh_;
  std::string frame_id_;
  ros::Publisher header_publisher_;
  std::deque<sensor_msgs::LaserScanPtr> d_queue_;
  std::mutex q_mutex_;
 
  std::shared_ptr<ScanConfig> config_;
  std::shared_ptr<ScanParameters> params_;
 
  bool check_status(uint32_t status_flags);
 
  template <typename T>
  void to_msg_queue(T& packet, uint16_t layer_idx = 0, int layer_inclination = 0);
  virtual void handle_scan(sensor_msgs::LaserScanPtr msg, uint16_t layer_idx, int layer_inclination,
                           bool apply_correction = true) = 0;
 
  virtual void resetCurrentScans()
  {
  }
};