ROS2 中的轻量级、自动化、受控回放

一、说明

这篇文章描述了一种在 ROS2 中实现受控重播器的轻量级方法。用以测试中将现象重新播放一遍，以实现调参或故障定位的目的。所有源代码都可以在这里找到。该帖子也可在此处获得。

二、问题：不同步重播

        任何曾经认真开发过 ROS2 的人都会知道这个问题：我们想调试我们的管道或改进算法的微小部分，但当我们反复运行管道时，我们得到了不同的结果。如果我们处于开发的早期阶段，并且我们的管道运行速度不够快，无法实时处理所有数据，我们最终会丢失消息。如果我们在代码中放置断点，我们最终会丢失消息。如果我们在后台的同一台机器上发生了一些完全不相关但半繁重的处理，我们最终会丢失消息。最糟糕的是，症状在每次运行之间可能会有所不同，从完全系统故障到对结果的影响最小，因此我们通常不会直接意识到消息丢失可能是问题所在。

        当然，我们可以非常缓慢地重播所有数据。但是，我们最终会永远等待，直到重播达到我们感兴趣的点。同样，如果我们想在CI服务器上运行管道，我们通常不知道有多少计算资源可用以及我们可以多快地运行我们的系统。

        总结：重播器以固定速率重播其消息，对于算法管道来说，这可能是快或慢。因此，我们要么失去时间，要么得到不确定的结果。

三、方法：受控回放

        解决这个问题的基本思想非常简单：我们需要一个考虑到管道当前状态的受控重放。然而，由于ROS2s的异步和松散耦合设计，实现这一点并非易事。特别是因为我们不想用“仅”开发所需的机制来混淆整个系统。

        不幸的是，ROS2 没有针对这个（在我看来非常明显）问题的构建解决方案。当然，它是开源的，我们可以着手实现我们自己的 ros bag 重播器。但是，如上所述，我们希望在框架内开发一种算法。我们不想先实现框架。幸运的是，到目前为止，ROS2工具已经发展了很多，并且只需相对较少的努力，我们就可以应用一种在实践中可以很好地工作的解决方法。

        这个概念是有一个额外的节点，就像重播者的遥控器一样。每当所有节点通知远程节点它们已准备就绪时，它都会触发新消息的重播。

四、实施

        使用服务客户端体系结构可以相对直接地完成实现，如下所述。包括一个小示例在内的所有代码都可以在这里找到。它也可以很容易地作为 ROS 包包含在内。

        远程是一个附加节点，充当rosbag2_replayer的代理。它使用“突发”服务每 T 秒触发接下来的 N 条消息，并等待每个节点的确认。实现自定义服务确实在调用方的身份旁边传输“就绪”信号。不幸的是，当我们使用突发调用“跳过”袋子时，重播者不会自动关闭。因此，额外的计时器会定期检查模拟时间是否仍在增加，以确定重播是否已结束。这要求重播者发布时钟（-clock），并使用 use-sim-time 参数集运行遥控器。然后，节点可以在重放结束时关闭自身/其整个组合。

        我们可以将其作为可组合节点包含，也可以通过以下方式启动它：

ros2 run controllable_replay remote --ros-args -p use_sim_time:=True -p batch_size:=10 -p period:=0.01 -p automatic_shutdown:=5

这将每 10 毫秒播放 10 条消息，并在重播者处于非活动状态 5 秒后关闭节点。

五、算法节点

        在算法方面，我们需要一些逻辑来通知遥控器我们已经准备好了。在简单节点中，我们可以在每个回调的末尾添加它。在更复杂的节点中，消息和回调之间可能没有一对一的映射。在这种情况下，需要一些额外的逻辑来监视节点的工作负载，例如通过观察输入队列大小。

        对于一个简单的示例，我们将创建一个字符串侦听器节点，该节点计算收到的消息数并模拟具有特定时间长度的繁重任务。任务完成后，它将发布自己的消息并通知远程设备已准备就绪。

#include "Listener.h"
using namespace std::chrono_literals; 
namespace controlled_replay_example { 
Listener::Listener(const rclcpp::NodeOptions& options) : 
rclcpp::Node("Listener", options),
_cliReady{create_client<controlled_replay_interfaces::srv::Ready>("/ready")},
_pub{create_publisher<std_msgs::msg::String>("/hearsay", 10)},
_sub{create_subscription<std_msgs::msg::String>( "/chatter", 10, [&](std_msgs::msg::String::ConstSharedPtr msg) { _ctr++; std::this_thread::sleep_for(get_parameter("task_time").as_double() * 1000ms); // heavy taskauto rq = std::make_shared<controlled_replay_interfaces::srv::Ready::Request>();rq->isready = true; _cliReady->async_send_request(rq); // inform replayer})}, _timer{create_wall_timer(1s, [&]() { RCLCPP_INFO(get_logger(), "Received messages: %ld", _ctr); })} 
{ declare_parameter("task_time", 1.0); } } 
// namespace controlled_replay_example 
#include "rclcpp_components/register_node_macro.hpp" 
RCLCPP_COMPONENTS_REGISTER_NODE(controlled_replay_example::Listener)

我们使用一个包含 464 个字符串消息的包以 100hz 的速率测试上面的示例。我们将模拟一个算法管道，其中包含两个具有不同时间长度的链节点。第一个节点将以 100hz 运行，但第二个节点仅以 2hz 运行。因此，从理论上讲，第一个节点应该能够处理所有消息，但第二个节点会错过一些消息。

在第一次运行中，我们将在没有远程的情况下简单地运行管道。

#!/bin/bash 
ros2 run controlled_replay_example listener --ros-args -p task_time:=0.01 -r __node:=listener1 & 
ros2 run controlled_replay_example listener --ros-args -p task_time:=0.5 -r __node:=listener2 -r chatter:=hearsay -r hearsay:=hearsay1& 
ros2 bag play bag

重放期间的节点图

[INFO] [1695973373.033875499] [listener2]: Received messages: 8 
[INFO] [1695973373.732552274] [listener1]: Received messages: 445

我们可以看到，即使是第一个节点也丢失了一些消息。但是，第一个只处理了8个！

在第二次运行中，我们将使用远程运行管道。


#!/bin/bash
ros2 run controlled_replay_example listener --ros-args -p task_time:=0.01 -r __node:=listener1 &
ros2 run controlled_replay_example listener --ros-args -p task_time:=0.5 -r __node:=listener2 -r chatter:=hearsay -r hearsay:=hearsay1 &
ros2 run controlled_replay remote --ros-args -p batch_size:=1 -p use_sim_time:=True &
ros2 bag play --clock --start-paused bag

具有受控回放的节点图

[INFO] [1695973373.033875499] [listener2]: Received messages: 464 
[INFO] [1695973373.732552274] [listener1]: Received messages: 464

我们可以看到两个节点都收到了所有消息。

六、结论

        我们已经看到了一种在 ROS2 中获得可控重放的简单方法。通过添加一个额外的远程节点，我们可以将大部分任务封装在远离实际管道的地方。遥控器将重播速度减慢到节点可以处理的任何速度，从而避免丢失消息。

此处提供的远程，可以通过 ROS2 包管理包含在内。

七、未解决的问题和未来工作

  • 很快，重播者应该可以作为可组合节点使用。我希望这将进一步提高重播速度。它应该与上述实现顺利配合。
  • 使用这些服务时，ros bag 重播器会向终端发送垃圾邮件，其中包含每个服务的消息，我没有找到一种方法来阻止日志记录部分将其重定向到 /dev/null。但是，这超过了重播者的所有输出
  • 最好找到更简单的方法来监视节点的工作负载，甚至可能是外部的工作负载。例如，如果我们能以某种方式访问待处理的回调，这已经有所帮助，但我没有找到做到这一点的方法。

本文来自互联网用户投稿，该文观点仅代表作者本人，不代表本站立场。本站仅提供信息存储空间服务，不拥有所有权，不承担相关法律责任。如若转载，请注明出处：http://www.xdnf.cn/news/145923.html

如若内容造成侵权/违法违规/事实不符，请联系一条长河网进行投诉反馈，一经查实，立即删除！

相关文章

springboot和vue：八、vue快速入门

springboot和vue：八、vue快速入门

vue快速入门 新建一个html文件 导入 vue.js 的 script 脚本文件 <script src"https://unpkg.com/vuenext"></script>在页面中声明一个将要被 vue 所控制的 DOM 区域&#xff0c;既MVVM中的View <div id"app">{{ message }} </div…
阅读更多...
uboot启动流程涉及reset汇编函数

uboot启动流程涉及reset汇编函数

一. uboot启动流程中函数 之前了解了uboot链接脚本文件 u-boot.lds。 从 u-boot.lds 中我们已经知道了入口点是 arch/arm/lib/vectors.S 文件中的 _start。 本文了解 一下&#xff0c;uboot启动过程中涉及的 reset 函数。本文继上一篇文章学习&#xff0c;地址如下&#xff…
阅读更多...
统计模型----决策树

统计模型----决策树

决策树 &#xff08;1&#xff09;决策树是一种基本分类与回归方法。它的关键在于如何构建这样一棵树。决策树的建立过程中&#xff0c;使用基尼系数来评估节点的纯度和划分的效果。基尼系数是用来度量一个数据集的不确定性的指标&#xff0c;其数值越小表示数据集的纯度越高。…
阅读更多...
揭秘：机构招生电子传单制作的五个黄金法则

揭秘：机构招生电子传单制作的五个黄金法则

机构招生微传单制作一直都是让很多人在意的事情。一款好的微传单不仅可以吸引更多的学生&#xff0c;还可以省去很多招生工作的时间和精力。但是&#xff0c;很多人却不知道如何制作一款精美的微传单。下面就让我们来学习一下如何制作一款机构招生的微传单吧。 首先&#xff0c…
阅读更多...
Egg 封装接口返回信息

Egg 封装接口返回信息

中间件封装 代码 const msgArr {"200":成功,"401":token失效 } module.exports (option, app) > {return async function(ctx, next) {try{//成功是返回的信息ctx.emit(code,data,msg)>{console.log(1111,code,data,msg)ctx.body {code,data:dat…
阅读更多...
springboot 简单配置mongodb多数据源

springboot 简单配置mongodb多数据源

准备工作&#xff1a; 本地mongodb一个创建两个数据库 student 和 student-two 所需jar包&#xff1a; # springboot基于的版本 <parent><groupId>org.springframework.boot</groupId><artifactId>spring-boot-starter-parent</artifactId>&l…
阅读更多...
C++之std::atomic解决多线程7个问题(二百四)

C++之std::atomic解决多线程7个问题(二百四)

简介&#xff1a; CSDN博客专家&#xff0c;专注Android/Linux系统&#xff0c;分享多mic语音方案、音视频、编解码等技术&#xff0c;与大家一起成长&#xff01; 优质专栏&#xff1a;Audio工程师进阶系列【原创干货持续更新中……】&#x1f680; 人生格言&#xff1a; 人生…
阅读更多...
竞赛选题 多目标跟踪算法 实时检测 - opencv 深度学习 机器视觉

竞赛选题 多目标跟踪算法 实时检测 - opencv 深度学习 机器视觉

文章目录 0 前言2 先上成果3 多目标跟踪的两种方法3.1 方法13.2 方法2 4 Tracking By Detecting的跟踪过程4.1 存在的问题4.2 基于轨迹预测的跟踪方式 5 训练代码6 最后 0 前言 &#x1f525; 优质竞赛项目系列&#xff0c;今天要分享的是 &#x1f6a9; 深度学习多目标跟踪 …
阅读更多...
uniapp使用scroll-into-view实现锚点定位和滚动监听功能【楼层效果 / 侧边导航联动效果】

uniapp使用scroll-into-view实现锚点定位和滚动监听功能【楼层效果 / 侧边导航联动效果】

大佬网址&#xff1a; https://blog.csdn.net/weixin_47136265/article/details/132303570 效果 代码 <template><!-- 这里面有2个bug&#xff0c;已经解决&#xff0c;需要知道的地方1.methods里的scrollEvt(e)方法里面的 this.tabIndex index ! -1 ? index :…
阅读更多...
MySQL - DML数据增删改

MySQL - DML数据增删改

功能介绍&#xff1a; DML&#xff08;Data Manipulation Language&#xff09;数据操作语言&#xff0c;用来对数据库中表的数据记录进 行增、删、改操作。 添加数据&#xff08;INSERT&#xff09; 基本语法&#xff1a;insert into 表名(字段列表) values (值列表); …
阅读更多...
el-collapse 嵌套中 el-checkbox作为标题，选中复选框与el-tree联动

el-collapse 嵌套中 el-checkbox作为标题，选中复选框与el-tree联动

<el-drawertitle"应用授权":visible.sync"menuDrawer"><el-collapse accordion style"padding: 15px"><el-collapse-item v-for"item in platList"><template slot"title"><el-checkbox v-model…
阅读更多...
Mysql各种锁

Mysql各种锁

一.不同存储引擎支持的锁机制 Mysql数据库有多种数据存储引擎&#xff0c;Mysql中不同的存储引擎支持不同的锁机制 MyISAM和MEMORY存储引擎采用的表级锁 InnoDB存储引擎支持行级锁&#xff0c;也支持表级锁&#xff0c;默认情况下采用行级锁 二.锁类型的划分 按照数据操作…
阅读更多...
postgresql-管理数据表

postgresql-管理数据表

postgresql-管理数据表 创建表数据类型字段约束表级约束模式搜索路径 修改表添加字段删除字段添加约束删除约束修改字段默认值修改字段数据类型重命名字段重命名表 删除表 创建表 在 PostgreSQL 中&#xff0c;使用 CREATE TABLE 语句创建一个新表&#xff1a; CREATE TABLE …
阅读更多...
深度学习笔记_1、定义神经网络

深度学习笔记_1、定义神经网络

1、使用了PyTorch的nn.Module类来定义神经网络模型;使用nn.Linear来创建全连接层。(CPU) import torch.nn as nn import torch.nn.functional as F from torchsummary import summary# 定义神经网络模型 class Net(nn.Module):def __init__(self):super(Net, self).__init__()…
阅读更多...
湖南软件测评公司简析：软件功能测试和非功能测试的联系和区别

湖南软件测评公司简析：软件功能测试和非功能测试的联系和区别

一、软件功能测试 　　软件功能测试旨在验证软件是否按照需求规格说明书的要求正常工作。具体而言&#xff0c;功能测试会对软件的所有功能进行测试&#xff0c;以确保其满足用户的需求和预期。在进行功能测试时&#xff0c;根据需求规格说明书编写测试用例&#xff0c;并在测试…
阅读更多...
std::initializer_list详解

std::initializer_list详解

std::initializer_list介绍 initializer_list是C11提供的一种新类型&#xff0c;其定义于头文件<initializer_list>中&#xff0c;此头文件是工具库的一部分&#xff0c; <initializer_list>定义如下&#xff1a; namespace std {template<class E> class…
阅读更多...
ubuntu22.04使用共享文件设置

ubuntu22.04使用共享文件设置

从ubuntu20.04开始&#xff0c;设置共享文件就很麻烦 第一步&#xff1a; 安装samba&#xff1a; sudo apt install samba第二步; 创建一个共享文件夹 我以桌面Desktop为例子 第三步&#xff1a; 设置密码&#xff1a; sudo smbpasswd -a ygc第四步&#xff1a; sudo vim …
阅读更多...
Pikachu靶场——XXE 漏洞

Pikachu靶场——XXE 漏洞

文章目录 1. XXE1.1 查看系统文件内容1.2 查看PHP源代码1.3 查看开放端口1.4 探测内网主机 1. XXE 漏洞描述 XXE&#xff08;XML External Entity&#xff09;攻击是一种利用XML解析器漏洞的攻击。在这种攻击中&#xff0c;攻击者通过在XML文件中插入恶意实体来触发解析器加载…
阅读更多...
亲测可用国产GPT人工智能

亲测可用国产GPT人工智能

分享一些靠谱、可用、可以白嫖的GPT大模型。配合大模型&#xff0c;工作效率都会极大提升。 清华大学ChatGLM 官网&#xff1a; 智谱清言中国版对话语言模型&#xff0c;与GLM大模型进行对话。https://chatglm.cn/开源的、支持中英双语的1300亿参数的对话语言模型&#xff0…
阅读更多...
CSP-J第二轮试题-2020年-1.2题

CSP-J第二轮试题-2020年-1.2题

文章目录 参考&#xff1a;总结 [CSP-J2020] 优秀的拆分题目描述输入格式输出格式样例 #1样例输入 #1样例输出 #1 样例 #2样例输入 #2样例输出 #2 提示样例 1 解释数据规模与约定 答案1答案2 [CSP-J2020] 直播获奖题目描述输入格式输出格式样例 #1样例输入 #1样例输出 #1 样例 …
阅读更多...
最新文章

Copyright @ 2022~2023