ros::AsyncSpinner 已经可以开辟许多线程来接收message,但是有时候我们需要指定某个线程来单独对摸个topic的message进行接收处理。
#include <ros/ros.h>
#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<sensor_msgs::Image>(_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函数处理消息。