ROS - C++实现RosBag包回放/提取

2024-09-08 13:04
文章标签 c++ 实现 提取 ros rosbag 回放

本文主要是介绍ROS - C++实现RosBag包回放/提取，希望对大家解决编程问题提供一定的参考价值，需要的开发者们随着小编来一起学习吧！

文章目录

    • 1. 回放原理
    • 2. 回放/提取 多个话题
    • 3. 回放/提取数据包，并实时发布

1. 回放原理


#include <ros/ros.h>
#include <rosbag/bag.h>
#include <std_msgs/String.h>int main(int argc, char** argv)
{// 初始化ROS节点ros::init(argc, argv, "play_bag_node");ros::NodeHandle nh;// 创建ROSbag对象，打开bag文件rosbag::Bag bag;bag.open("example.bag", rosbag::bagmode::Read);// 获取名为"my_topic"的话题的迭代器rosbag::View view(bag, rosbag::TopicQuery("my_topic"));// 循环遍历话题中的所有消息for (rosbag::View::iterator it = view.begin(); it != view.end(); ++it){// 转换消息类型std_msgs::String::ConstPtr msg = it->instantiate<std_msgs::String>();if (msg != NULL){// 打印消息内容ROS_INFO("Message: %s", msg->data.c_str());}}// 关闭bag文件bag.close();return 0;
}

在上面的代码中：

  • 我们首先初始化了ROS节点，

  • 然后创建了一个ROSbag对象，

  • 打开了一个名为"example.bag"的bag文件，

  • 接着获取了名为"my_topic"的话题的迭代器，并循环遍历话题中的所有消息。

  • 在每个消息中，我们将其转换为String类型，并打印其内容。

  • 最后关闭了bag文件。

请注意，这只是一个示例，你需要根据你自己的需求修改ROS话题和消息类型。

2. 回放/提取 多个话题


#include <ros/ros.h>
#include <rosbag/bag.h>
#include <std_msgs/String.h>
#include <sensor_msgs/Image.h>
#include <sensor_msgs/LaserScan.h>int main(int argc, char** argv)
{// 初始化ROS节点ros::init(argc, argv, "play_bag_node");ros::NodeHandle nh;// 创建ROSbag对象，打开bag文件rosbag::Bag bag;bag.open("example.bag", rosbag::bagmode::Read);// 获取三个话题的迭代器rosbag::View view(bag, rosbag::TopicQuery("my_string_topic") && rosbag::TopicQuery("my_image_topic") && rosbag::TopicQuery("my_laser_topic"));// 循环遍历话题中的所有消息for (rosbag::View::iterator it = view.begin(); it != view.end(); ++it){// 从bag文件中读取消息const rosbag::MessageInstance& msg = *it;// 根据消息类型进行强制转换if (msg.isType<std_msgs::String>()) {std_msgs::String::ConstPtr str_msg = msg.instantiate<std_msgs::String>();ROS_INFO_STREAM("String message: " << str_msg->data);}else if (msg.isType<sensor_msgs::Image>()) {sensor_msgs::Image::ConstPtr img_msg = msg.instantiate<sensor_msgs::Image>();ROS_INFO_STREAM("Image message: " << img_msg->header.stamp);// 在此处添加处理Image消息的代码}else if (msg.isType<sensor_msgs::LaserScan>()) {sensor_msgs::LaserScan::ConstPtr scan_msg = msg.instantiate<sensor_msgs::LaserScan>();ROS_INFO_STREAM("LaserScan message: " << scan_msg->header.stamp);// 在此处添加处理LaserScan消息的代码}}// 关闭bag文件bag.close();return 0;}

在上面的代码中，我们首先创建了一个ROSbag对象，并打开了名为"example.bag"的ROSbag文件。然后，我们通过rosbag::TopicQuery函数获取了三个话题的迭代器，并循环遍历了所有话题的消息。在循环中，我们使用rosbag::MessageInstance对象来读取每条消息，并根据消息类型进行强制转换，以便能够对每个消息进行处理。最后，我们关闭了ROSbag文件。

请注意，以上代码中仅仅输出了每条消息的时间戳和消息内容，您可以根据需要修改代码来处理具体的消息内容。同时，如果需要处理更多的ROS话题，只需在代码中添加相应的话题即可。

3. 回放/提取数据包，并实时发布


#include <rosbag/bag.h>
#include <rosbag/view.h>
#include <ros/ros.h>
#include <string>
#include <vector>
// 定义一个函数，用于回放多个话题的数据
// 参数：
// - bag_filename: ROSbag文件名
// - topics: 一个包含多个话题名的vector，如果为空，则回放所有话题的数据
void playbackRosbag(const std::string& bag_filename, const std::vector<std::string>& topics = {}) {// 创建ROS节点// ros::NodeHandle nh("~");ros::NodeHandle nh;//sukai// 创建ROS话题发布器std::vector<ros::Publisher> pubs;for (const auto& topic : topics.empty() ? bag.getTopics() : topics) {if (topic == "/image") {pubs.push_back(nh.advertise<sensor_msgs::Image>(topic, 1));}else if (topic == "/scan") {pubs.push_back(nh.advertise<sensor_msgs::LaserScan>(topic, 1));}else if (topic == "/string") {pubs.push_back(nh.advertise<std_msgs::String>(topic, 1));}else {ROS_WARN_STREAM("Unknown topic: " << topic);}}// 回放数据// rosbag::Bag bag(bag_filename, rosbag::bagmode::Read);rosbag::Bag bag;//sukaibag.open(bag_filename, rosbag::bagmode::Read); //sukairosbag::View view(bag, rosbag::TopicQuery(topics.empty() ? bag.getTopics() : topics));for (const auto& msg : view) {ros::Time timestamp = msg.getTime();std::string topic = msg.getTopic();if (topic == "/image") {sensor_msgs::Image::ConstPtr image = msg.instantiate<sensor_msgs::Image>();if (image != nullptr) {pubs[0].publish(image);}}else if (topic == "/scan") {sensor_msgs::LaserScan::ConstPtr scan = msg.instantiate<sensor_msgs::LaserScan>();if (scan != nullptr) {pubs[1].publish(scan);}}else if (topic == "/string") {std_msgs::String::ConstPtr str = msg.instantiate<std_msgs::String>();if (str != nullptr) {pubs[2].publish(str);}}else {ROS_WARN_STREAM("Unknown topic: " << topic);}}// 关闭ROSbag文件bag.close();ROS_INFO_STREAM("Playback finished!");
}

// 示例使用
int main(int argc, char** argv) {
ros::init(argc, argv, "rosbag_recorder_player");// 回放ROSbag文件中的所有话题数据
playbackRosbag(bag_filename);// 回放ROSbag文件中的指定话题数据
std::vectorstd::string playback_topics = {"/scan", "/string"};
playbackRosbag(bag_filename, playback_topics);return 0;
}

这篇关于ROS - C++实现RosBag包回放/提取的文章就介绍到这儿，希望我们推荐的文章对编程师们有所帮助！


http://www.chinasem.cn/article/1148188。

相关文章

windos server2022里的DFS配置的实现

windos server2022里的DFS配置的实现

《windosserver2022里的DFS配置的实现》DFS是WindowsServer操作系统提供的一种功能,用于在多台服务器上集中管理共享文件夹和文件的分布式存储解决方案,本文就来介绍一下wi... 目录什么是DFS？优势：应用场景：DFS配置步骤什么是DFS？DFS指的是分布式文件系统（Distr
阅读更多...
NFS实现多服务器文件的共享的方法步骤

NFS实现多服务器文件的共享的方法步骤

《NFS实现多服务器文件的共享的方法步骤》NFS允许网络中的计算机之间共享资源,客户端可以透明地读写远端NFS服务器上的文件,本文就来介绍一下NFS实现多服务器文件的共享的方法步骤,感兴趣的可以了解一... 目录一、简介二、部署1、准备1、服务端和客户端：安装nfs-utils2、服务端：创建共享目录3、服
阅读更多...
C#使用yield关键字实现提升迭代性能与效率

C#使用yield关键字实现提升迭代性能与效率

《C#使用yield关键字实现提升迭代性能与效率》yield关键字在C#中简化了数据迭代的方式,实现了按需生成数据,自动维护迭代状态,本文主要来聊聊如何使用yield关键字实现提升迭代性能与效率,感兴... 目录前言传统迭代和yield迭代方式对比yield延迟加载按需获取数据yield break显式示迭
阅读更多...
Python实现高效地读写大型文件

Python实现高效地读写大型文件

《Python实现高效地读写大型文件》Python如何读写的是大型文件,有没有什么方法来提高效率呢,这篇文章就来和大家聊聊如何在Python中高效地读写大型文件,需要的可以了解下... 目录一、逐行读取大型文件二、分块读取大型文件三、使用 mmap 模块进行内存映射文件操作（适用于大文件）四、使用 pand
阅读更多...
python实现pdf转word和excel的示例代码

python实现pdf转word和excel的示例代码

《python实现pdf转word和excel的示例代码》本文主要介绍了python实现pdf转word和excel的示例代码,文中通过示例代码介绍的非常详细,对大家的学习或者工作具有一定的参考学习价... 目录一、引言二、python编程1，PDF转Word2，PDF转Excel三、前端页面效果展示总结一
阅读更多...
Python xmltodict实现简化XML数据处理

Python xmltodict实现简化XML数据处理

《Pythonxmltodict实现简化XML数据处理》Python社区为提供了xmltodict库,它专为简化XML与Python数据结构的转换而设计,本文主要来为大家介绍一下如何使用xmltod... 目录一、引言二、XMLtodict介绍设计理念适用场景三、功能参数与属性1、parse函数2、unpa
阅读更多...
C#实现获得某个枚举的所有名称

C#实现获得某个枚举的所有名称

《C#实现获得某个枚举的所有名称》这篇文章主要为大家详细介绍了C#如何实现获得某个枚举的所有名称,文中的示例代码讲解详细,具有一定的借鉴价值,有需要的小伙伴可以参考一下... C#中获得某个枚举的所有名称using System;using System.Collections.Generic;usi
阅读更多...
Go语言实现将中文转化为拼音功能

Go语言实现将中文转化为拼音功能

《Go语言实现将中文转化为拼音功能》这篇文章主要为大家详细介绍了Go语言中如何实现将中文转化为拼音功能,文中的示例代码讲解详细,感兴趣的小伙伴可以跟随小编一起学习一下... 有这么一个需求：新用户入职 创建一系列账号比较麻烦，打算通过接口传入姓名进行初始化。想把姓名转化成拼音。因为有些账号即需要中文也需要英
阅读更多...
C# 读写ini文件操作实现

C# 读写ini文件操作实现

《C#读写ini文件操作实现》本文主要介绍了C#读写ini文件操作实现,文中通过示例代码介绍的非常详细,对大家的学习或者工作具有一定的参考学习价值,需要的朋友们下面随着小编来一起学习学习吧... 目录一、INI文件结构二、读取INI文件中的数据在C#应用程序中，常将INI文件作为配置文件，用于存储应用程序的
阅读更多...
C#实现获取电脑中的端口号和硬件信息

C#实现获取电脑中的端口号和硬件信息

《C#实现获取电脑中的端口号和硬件信息》这篇文章主要为大家详细介绍了C#实现获取电脑中的端口号和硬件信息的相关方法,文中的示例代码讲解详细,有需要的小伙伴可以参考一下... 我们经常在使用一个串口软件的时候，发现软件中的端口号并不是普通的COM1，而是带有硬件信息的。那么如果我们使用C#编写软件时候，如
阅读更多...

Copyright China编程 23002807@qq.com

沪ICP备2023033072号-2