ROS中单独开辟线程接受message

ros::AsyncSpinner 已经可以开辟许多线程来接收message,但是有时候我们需要指定某个线程来单独对摸个topic的message进行接收处理。

#include 
#include "ros/callback_queue.h"
void processImageGrabed(const sensor_msgs::Image::ConstPtr &pImage)
{
     cv_bridge::CvImagePtr cv_ptr = cv_bridge::toCvCopy(pImage, sensor_msgs::image_encodings::BGR8);
     string sImageFile = image_folder + "/" + pImage->header.frame_id;
     cv::imwrite(sImageFile, cv_ptr->image);
}

void save_thread_func()
{
    ros::NodeHandle node;
    ros::SubscribeOptions ops;
    ops.template init(_image_grabed_topic, 1000000, processImageGrabed);
    ros::CallbackQueue queue;
    ops.callback_queue = &queue;
    ros::Subscriber sub = node.subscribe(ops);
    while(node.ok())
    {
        queue.callAvailable(ros::WallDuration(0.1));
    }
}

int main(int argc, char **argv)  
{
    ros::init(argc, argv, "_node");
    std::thread t_saveImage(save_thread_func);
    ros::spin();
    return 0;  
}
关键实现在线程函数save_thread_func()中,收到message后processImageGrabed()作为callback函数处理消息。

你可能感兴趣的:(ROS,机器人)