Callback of Subscriber as a Function of a Class isn't Called

edit

Hi all, I was trying to make a class for my program handler including subscriber and publisher. But I'm stuck since 2 weeks without no progress. Somehow the callback function isn't called...

my main file

#include <ros/ros.h>
#include "pointcloud_reader_handler.h"

int main(int argc, char **argv) {

ros::init(argc, argv, "pointcloud_reader");
ros::NodeHandle private_node_handle_("~");
// class object which handle the package
pointcloud_reader_handler myReaderHandle(private_node_handle_);

// ros spin with the rate time
ros::Rate naptime(myReaderHandle.getNodeRate());

// Main Loop
while(ros::ok())
{
    myReaderHandle.run();
    // sleep for given rate(time)
    ros::spinOnce();
    naptime.sleep();
}
return 0;
 }

my pointcloud reader handler

#include <ros/ros.h>
#include "pointcloud_reader_handler.h"

// Constructor
pointcloud_reader_handler::pointcloud_reader_handler(ros::NodeHandle &nodeHandle):
nodeHandle_(nodeHandle) {
    ROS_INFO("Construction Handle");
    loadParameters();
    ROS_INFO("Subscribing topic starting");
    subscribeToTopics();
    publishToTopics();
}

// Getters
int pointcloud_reader_handler::getNodeRate() const {return node_rate_;}

// Methods
void pointcloud_reader_handler::loadParameters() {
// add parameters from cfg file here
}

void pointcloud_reader_handler::subscribeToTopics() {
    ROS_INFO("Subscribing topic");
    pointcloud_reader_handler::lidarSubscriber_ = nodeHandle_.subscribe<sensor_msgs::PointCloud2>
    (lidar_input_topic_name_, input_message_queue_, 
    &pointcloud_reader_handler::lidarReadingCallback, this);
    }

void pointcloud_reader_handler::publishToTopics() {
    ROS_INFO("publish to topics");
    lidarPublisher_ = nodeHandle_.advertise<sensor_msgs::PointCloud2>(lidar_cone_filter_topic_name_, output_filter_message_queue_);
    detectionPublisher_ = nodeHandle_.advertise<fsd_common_msgs::Detection>(lidar_cone_detection_topic_name_, output_detection_message_queue_);
    detectionLidarPublisher_ = nodeHandle_.advertise<sensor_msgs::PointCloud2>(lidar_cone_detection_pointcloud_topic_name_, output_detection_pointcloud_message_queue_);
}

void pointcloud_reader_handler::run() {
     // do stuff here
}

void pointcloud_reader_handler::lidarReadingCallback(const sensor_msgs::PointCloud2ConstPtr& pointCloudMsg) {
    ROS_INFO("Filtering Lidar Point Cloud");
    pointCloudPreProcessing_.updateInputCloud(pointCloudMsg);
}

Some small detail:

• There is no error in compiling.
• The topic that I want to subscribe is there
• The lidarSubscriber_ is declared (private/public, both doesnt work) in the class.

The output I get with rosrun is:

[ INFO] [1581362020.241452441]: Construction Handle
[ INFO] [1581362020.244867156]: Subscribing topic starting
[ INFO] [1581362020.244876716]: Subscribing topic
[ INFO] [1581362020.245867283]: publish to topics
perception_lidar: /usr/include/boost/smart_ptr/shared_ptr.hpp:728: typename boost::detail::sp_dereference<T>::type boost::shared_ptr<T>::operator*() const [with T = const sensor_msgs::PointCloud2_<std::allocator<void> >; typename boost::detail::sp_dereference<T>::type = const sensor_msgs::PointCloud2_<std::allocator<void> >&]: Assertion `px != 0' failed.

So, as I debuged the code and also with print message, I noticed that the function is called which prints

[ INFO] [1581362020.244876716]:0 Subscribing topic

but not the message

Filtering Lidar Point Cloud

it jumps directly to publish topic. Means the callback function is not called.

Please if anyone can help. Thank you guys.

EDIT: header file

#ifndef SRC_POINTCLOUD_READER_HANDLER_H
#define SRC_POINTCLOUD_READER_HANDLER_H

#include "PointCloudPreProcessing.h"
#include "ObjectDetection.h"
#include <sensor_msgs/PointCloud2.h>

class pointcloud_reader_handler {
public:

    // Constructor
    pointcloud_reader_handler(ros::NodeHandle &nodeHandle);

    // Getters
    int getNodeRate() const;

    // Methods
    void loadParameters();
    void subscribeToTopics();
    void publishToTopics();
    void run();
    ros::Publisher lidarPublisher_;
    ros::Subscriber lidarSubscriber_;

private:
    ros::NodeHandle nodeHandle_;
    ros::Publisher detectionPublisher_;
    ros::Publisher detectionLidarPublisher_;

    void lidarReadingCallback(const sensor_msgs::PointCloud2ConstPtr& pointCloudMsg);

    std::string lidar_input_topic_name_;
    std::string lidar_cone_filter_topic_name_;
    std::string lidar_cone_detection_topic_name_;
    std::string lidar_cone_detection_pointcloud_topic_name_;
    std::string frame_id_;

   // some other variables

    PointCloudPreProcessing pointCloudPreProcessing_;
    sensor_msgs::PointCloud2Ptr points_filtered_;
};

#endif //SRC_POINTCLOUD_READER_HANDLER_H