如何读取rosbag中的标准消息？(C++)

最新推荐文章于 2024-10-05 16:30:00 发布

点解质

最新推荐文章于 2024-10-05 16:30:00 发布

阅读量3.7k

点赞数 1

分类专栏： ROS 文章标签： ROS

本文链接：https://blog.csdn.net/yuanshine/article/details/94569998

版权

ROS 专栏收录该内容

3 篇文章 0 订阅

订阅专栏

#include <rosbag/bag.h>
#include <rosbag/view.h>
#include <std_msgs/Int32.h>
#include <std_msgs/String.h>

#include <boost/foreach.hpp>
#define foreach BOOST_FOREACH

rosbag::Bag bag;
bag.open("test.bag", rosbag::bagmode::Read);

std::vector<std::string> topics;
topics.push_back(std::string("chatter"));
topics.push_back(std::string("numbers"));

rosbag::View view(bag, rosbag::TopicQuery(topics));

foreach(rosbag::MessageInstance const m, view)
{
    std_msgs::String::ConstPtr s = m.instantiate<std_msgs::String>();
    if (s != NULL)
        std::cout << s->data << std::endl;

    std_msgs::Int32::ConstPtr i = m.instantiate<std_msgs::Int32>();
    if (i != NULL)
        std::cout << i->data << std::endl;
}

bag.close();