1 前言

众所周知,ubuntu中播放bag包最主要的工具是rviz,然而rviz有一个无法忍受的缺陷就是不支持鼠标回滚,并且显示的时间的ros时间,不是世界时间,因此在遇到相关bug时不能与对应的世界时间对应。基于以上,解决方案如下:

2 依托工具

foxglove,这个工具可以实现bag包的播放,相关安装下载的可以网上搜索一下,相关资料很多。

3 相关修改

fox-glove是一个很好用的工具,但是对于ros1不是很友好,对于点云格式为pointcloud的消息不能显示,要想显示有两种方式,一是写一个foxglove的插件,二是将pointcloud转换为pointcloud2格式,写插件相对复杂,因此选用更方便的改写方式,python脚本如下:

#!/usr/bin/env python3
import rosbag
from sensor_msgs.msg import PointCloud, PointCloud2, PointField
import struct
import sys
import timedef convert_pointcloud_to_pointcloud2(pc_msg):"""将 PointCloud 消息转换为 PointCloud2 格式"""# 创建 PointCloud2 消息pc2_msg = PointCloud2()# 复制头信息pc2_msg.header = pc_msg.header# 设置点云属性pc2_msg.height = 1  # 无序点云pc2_msg.width = len(pc_msg.points)  # 点的数量pc2_msg.is_dense = True  # 所有点都有效pc2_msg.is_bigendian = False  # 小端字节序# 设置字段(x, y, z)pc2_msg.fields = [PointField(name='x', offset=0, datatype=PointField.FLOAT32, count=1),PointField(name='y', offset=4, datatype=PointField.FLOAT32, count=1),PointField(name='z', offset=8, datatype=PointField.FLOAT32, count=1),]# 计算每个点的大小pc2_msg.point_step = 16  # 4 bytes * 4 (x, y, z, 填充字段)pc2_msg.row_step = pc2_msg.point_step * pc2_msg.width# 构建点云数据缓冲区buffer = bytearray()for point in pc_msg.points:# 打包每个点的坐标 (x, y, z)buffer += struct.pack('fff', point.x, point.y, point.z)# 添加填充字段 (通常用于颜色或强度数据)buffer += struct.pack('f', 0.0)pc2_msg.data = bytes(buffer)return pc2_msgdef convert_bag(input_bag_path, output_bag_path):"""转换整个 bag 文件"""print(f"开始转换: {input_bag_path} -> {output_bag_path}")start_time = time.time()# 跟踪转换进度pointcloud_topics = set()converted_messages = 0with rosbag.Bag(input_bag_path, 'r') as in_bag, \rosbag.Bag(output_bag_path, 'w') as out_bag:# 读取并转换消息total_messages = in_bag.get_message_count()processed_messages = 0for topic, msg, t in in_bag.read_messages():processed_messages += 1if processed_messages % 100 == 0:percent = (processed_messages / total_messages) * 100print(f"进度: {percent:.1f}% ({processed_messages}/{total_messages})")if msg._type == 'sensor_msgs/PointCloud':# 转换点云消息pc2_msg = convert_pointcloud_to_pointcloud2(msg)new_topic = f"{topic}_pc2"  # 使用新话题名称out_bag.write(new_topic, pc2_msg, t)pointcloud_topics.add(topic)converted_messages += 1else:# 其他类型消息直接复制out_bag.write(topic, msg, t)end_time = time.time()print(f"\n转换完成! 耗时: {end_time - start_time:.2f}秒")print(f"转换了 {converted_messages} 条 PointCloud 消息")print("包含 PointCloud 的话题:")for topic in pointcloud_topics:print(f"  - {topic} -> {topic}_pc2")if __name__ == "__main__":if len(sys.argv) != 3:print("用法: python3 convert_pointcloud_to_pointcloud2.py 输入.bag 输出.bag")print("示例: python3 convert_pointcloud_to_pointcloud2.py new.bag converted.bag")sys.exit(1)input_bag = sys.argv[1]output_bag = sys.argv[2]try:convert_bag(input_bag, output_bag)print("\n请使用以下命令验证转换结果:")print(f"rosbag info {output_bag} | grep PointCloud")print(f"rosbag play {output_bag}")except Exception as e:print(f"转换出错: {e}")sys.exit(1)

转换完的bag包就可以使用fox-glove播放了,为了更方便的播放,写相关shell脚本如下:

#!/usr/bin/env bash
set -e# 脚本入参:原始bag路径
BAG_PATH="$1"# 判断是否传入参数
if [ -z "$BAG_PATH" ]; thenecho "Usage: $0 <bag_path>"exit 1
fi# 判断文件是否存在
if [ ! -f "$BAG_PATH" ]; thenecho "Error: Bag file '$BAG_PATH' does not exist."exit 1
fi# 提取不带后缀的文件名
BAG_DIR=$(dirname "$BAG_PATH")
BAG_BASE=$(basename "$BAG_PATH" .bag)# 定义新的bag文件名
NEW_BAG_PATH="${BAG_DIR}/${BAG_BASE}_converted.bag"echo "Starting conversion:"
echo "  Input bag: $BAG_PATH"
echo "  Output bag: $NEW_BAG_PATH"
#bagconvert是上述的py脚本使用pyinstaller打包成的可执行文件,相关资料也很多,实在不会的直接下载我打包好的
bagconvert "$BAG_PATH" "$NEW_BAG_PATH"
echo "Opening with foxglove-studio: $NEW_BAG_PATH"rm -f "$BAG_PATH"
foxglove-studio $NEW_BAG_PATH

本文来自互联网用户投稿,该文观点仅代表作者本人,不代表本站立场。本站仅提供信息存储空间服务,不拥有所有权,不承担相关法律责任。
如若转载,请注明出处:http://www.pswp.cn/pingmian/88577.shtml
繁体地址,请注明出处:http://hk.pswp.cn/pingmian/88577.shtml
英文地址,请注明出处:http://en.pswp.cn/pingmian/88577.shtml

如若内容造成侵权/违法违规/事实不符,请联系英文站点网进行投诉反馈email:809451989@qq.com,一经查实,立即删除!

相关文章

一文理解缓存的本质:分层架构、原理对比与实战精粹

&#x1f4d6; 推荐阅读&#xff1a;《Yocto项目实战教程:高效定制嵌入式Linux系统》 &#x1f3a5; 更多学习视频请关注 B 站&#xff1a;嵌入式Jerry 一文理解缓存的本质&#xff1a;分层架构、原理对比与实战精粹 “缓存让系统飞起来”——但每一层缓存有何不同&#xff1f;…

【离线数仓项目】——电商域DIM层开发实战

摘要本文主要介绍了电商域离线数仓项目中DIM层的开发实战。首先阐述了DIM层的简介、作用、设计特征、典型维度分类以及交易支付场景下的表示例和客户维度表设计。接着介绍了DIM层设计规范&#xff0c;包括表结构设计规范、数据处理规范以及常见要求规范。然后详细讲解了DIM层的…

Unreal Engine 自动设置图像

void UYtGameSettingSubsystem::RunHardwareBenchmark(int32 WorkScale, float CPUMultiplier, float GPUMultiplier) {UGameUserSettings* UserSettings UGameUserSettings::GetGameUserSettings();if (UserSettings){// 运行基准测试&#xff08;异步操作&#xff0c;可能需…

使用Spring Boot和PageHelper实现数据分页

在Spring Boot项目中&#xff0c;利用PageHelper插件可以轻松实现数据分页功能。以下是具体的实现步骤和代码示例。添加依赖在项目的pom.xml文件中添加PageHelper和MyBatis的依赖。<dependency><groupId>com.github.pagehelper</groupId><artifactId>p…

【IT-Infra】从ITIL到CMDB,配置管理,资产管理,物理机与设备管理(含Infra系列说明)

【IT-Infra】从ITIL到CMDB&#xff0c;配置管理&#xff0c;资产管理&#xff0c;物理机与设备管理&#xff08;含Infra系列说明&#xff09; 文章目录序&#xff1a;Infra系列说明1、ITIL 信息技术基础架构库&#xff08;起源&#xff09;2、CMDB 配置管理数据库&#xff08;I…

vue使用printJS实现批量打印及单个打印 避免空白页

本文介绍了使用print-js库实现批量打印功能的实现方法。通过安装print-js依赖后,创建一个batchPrintAction方法,该方法接收选中行数据,生成包含多个标签页的HTML字符串。每个标签页以表格形式展示6个数据字段,并设置了80mm50mm的标签尺寸。方法使用PrintJS进行打印,配置了…

C++ 选择排序、冒泡排序、插入排序

选择排序&#xff1a;是一种简单直观的排序算法&#xff0c;每次均是选择最小&#xff08;大&#xff09;的元素进行排序。选择排序算法思想&#xff1a;1 在未排序序列中找到最小&#xff08;大&#xff09;元素&#xff0c;存放到排序序列的起始位置2 再从剩余未排序元素中继…

Linux入门篇学习——Linux 编写第一个自己的命令,make 工具和 makefile 文件

目录 一、Linux 编写第一个自己的命令 1.命令的概念 2.定义一个自己的命令 二、make 工具和 makefile 文件 1.使用 make 工具 2.makefile文件 一、Linux 编写第一个自己的命令 1.命令的概念 命令就是可执行程序。 比如说我们输入 ls -al &#xff0c;ls 就是可执行程序的…

实验一 接苹果

主要步骤苹果树制作&#xff08;苹果与篮子的制作同理&#xff09;为苹果添加标签相机位置设置与游戏面板长宽比设置&#xff08;16:9&#xff09;苹果下落设置&#xff08;将苹果从平抛运动改为垂直下落&#xff09;通过设置物理图层并更改碰撞矩阵表实现通过PlayerPrefs实现游…

Nginx服务器集群:横向扩展与集群解决方案

横向扩展&#xff1a;基础概念 在深入了解Nginx的横向扩展细节之前&#xff0c;首先理解横向扩展的含义及其重要性。横向扩展是指通过增加服务器数量来分散负载并提升整体性能。这与纵向扩展形成对比&#xff0c;纵向扩展是指在单个服务器上增加更多资源&#xff08;如CPU、内…

缺陷的生命周期(Bug Life Cycle)是什么?

一、缺陷生命周期的定义缺陷生命周期是指一个Bug从被发现到最终关闭的完整流程&#xff0c;反映了缺陷在不同角色&#xff08;测试、开发、产品等&#xff09;间的流转状态。它是软件测试流程的核心管理模型&#xff0c;直接影响团队协作效率。二、标准缺陷生命周期阶段以下是通…

AtCoder Beginner Contest 333(A,B,C,D,E,F)

AtCoder Beginner Contest 333 A 题意 输出n个n(n<9) 代码 #include<bits/stdc.h> using namespace std; void solve(){int n;cin>>n;for(int i1;i<n;i)cout<<n; } signed main(){ios::sync_with_stdio(0),cin.tie(0),cout.tie(0);int T__1;//cin…

留学真相:凌晨两点被海关拦下时,我才明白人生没有退路

> 独立不是选择&#xff0c;而是生存的必修课下飞机那一刻&#xff0c;幻想中的“镀金生活”瞬间崩塌。伦敦海关凌晨两点的灯光下&#xff0c;你颤抖着翻找学校文件&#xff0c;手机信号格空空如也&#xff1b;大巴误点后&#xff0c;你拖着两个32公斤的行李箱站在阴雨中&am…

探索AIGC领域DALL·E 2的图像生成与人类创意的融合

探索AIGC领域DALLE 2的图像生成与人类创意的融合关键词&#xff1a;AIGC、DALLE 2、图像生成、人类创意、创意融合摘要&#xff1a;本文聚焦于AIGC领域中DALLE 2的图像生成技术与人类创意的融合。首先介绍了相关背景&#xff0c;包括DALLE 2的发展历程和人类创意在艺术创作中的…

【ECharts】多个ECharts版本共存解决方案

多个ECharts版本共存解决方案 在单个HTML页面中使用多个ECharts版本的关键在于避免全局命名空间冲突。下面我将展示一个完整的解决方案&#xff0c;包含两种不同的实现方法。 解决方案思路命名空间隔离法&#xff1a; 使用不同的全局变量名保存不同版本的ECharts在加载新版本前…

力扣热门算法题 204.计数质数,207.课程表,213.打家劫舍II

力扣热门算法题 204.计数质数&#xff0c;207.课程表&#xff0c;213.打家劫舍II&#xff0c;每题做详细思路梳理&#xff0c;配套Python&Java双语代码&#xff0c; 2025.07.07 可通过leetcode所有测试用例。 目录 204.计数质数 解题思路 完整代码 207.课程表 解题思…

深入理解 macOS 的 quarantine、xattr 与 Gatekeeper

在 macOS 上安装第三方应用时&#xff0c;你是否遇到过如下提示&#xff1f; “xxx.app 已损坏&#xff0c;无法打开。”“无法打开‘xxx.app’&#xff0c;因为它来自身份不明的开发者。”“你确定要打开这个应用吗&#xff1f;它是从互联网下载的。” 这些提示背后&#xff0…

FastAPI学习笔记记录

FastAPI 学习笔记 最近在公司中需要写接口&#xff0c;选取了fastapi这个框架&#xff0c;一个原因是FastAPI 是主流框架&#xff0c;同时FastAPI 有着高性能&#xff0c;支持异步和高并发。 FastAPI 安装 直接用下面两行命令进行安装 pip3 install fastapi pip install uvicor…

HTML(上)

1.web标准主要包括结构(Structure)、表现(Presentation)和行为(Behavior)三个方面。1.1 结构结构用于对网页元素进行整理和分类&#xff0c;核心技术&#xff1a;HTML。 HTML (HyperText Markup Language)&#xff1a;超文本标记语言&#xff0c;用于定义网页的内容和结构&…

杭州乐湾科技有限公司的背景、产品体系与技术能力的全方位深度分析

杭州乐湾科技有限公司的背景、产品体系与技术能力的全方位深度分析 文章目录杭州乐湾科技有限公司的背景、产品体系与技术能力的全方位深度分析**一、公司背景&#xff1a;智慧养老赛道领跑者****1. 基础信息****2. 发展里程碑****二、产品体系&#xff1a;全域智慧养老解决方案…