机器人系统ros2-开发实践03-监听节点的参数变化(C++)

背景:

通常,节点需要响应其自身参数或另一个节点参数的更改。 ParameterEventHandler 类可以轻松侦听参数更改,以便您的代码可以响应它们。本教程将向您展示如何使用 ParameterEventHandler 类的 C++ 版本来监视节点自身参数的更改以及另一个节点参数的更改。

应用场景

  • 动态配置:在机器人系统中,经常需要根据不同的环境或任务需求动态调整算法的参数。例如,调整机器人速度、感知算法的灵敏度等。通过监听参数的变化,系统可以即时响应并调整运行参数,而无需重启节点。
  • 实时调试和优化:开发者或操作者可以在系统运行时实时修改参数,以测试不同配置的效果,从而找到最优解。这对于算法的调试和优化尤为重要。
  • 适应性控制:在变化的环境条件下,如光照、温度或机器人负载变化时,能够自动调整控制策略的参数,使得机器人能更好地适应环境变化。
  • 用户交互:在需要用户输入或选择配置的应用中,监听参数变化可以使得系统更加响应用户的操作,提供更加灵活和个性化的服务。
  • 条件触发:可以设置参数监听来作为触发某些操作的条件,例如当监测到特定参数达到某个阈值时自动启动或停止某个过程。
  • 故障响应:通过实时监控关键参数,系统可以在参数异常时快速做出反应,执行如错误记录、发送警报或启动备用系统等应对措施。

1. 创建包

导航到ros2_study /src并在那里创建一个新包:

ros2 pkg create --build-type ament_cmake --license Apache-2.0 cpp_parameter_event_handler --dependencies rclcpp

cpp_parameter_event_handler您的终端将返回一条消息,验证您的包及其所有必需文件和文件夹的创建。

--dependencies参数将自动将必要的依赖行添加到package.xml和CMakeLists.txt。

1.1 更新package.xml

由于您--dependencies在包创建期间使用了该选项,因此无需手动将依赖项添加到package.xml或CMakeLists.txt。

  1. 编写实现代码

在这里插入图片描述
在ros2_ws/study/cpp_parameter_event_handler/src目录中,创建一个名为的新文件parameter_event_handler.cpp,并将以下代码粘贴到其中:

#include <memory>#include "rclcpp/rclcpp.hpp"class SampleNodeWithParameters : public rclcpp::Node
{
public:SampleNodeWithParameters(): Node("node_with_parameters"){this->declare_parameter("an_int_param", 0);// Create a parameter subscriber that can be used to monitor parameter changes// (for this node's parameters as well as other nodes' parameters)param_subscriber_ = std::make_shared<rclcpp::ParameterEventHandler>(this);// Set a callback for this node's integer parameter, "age"auto cb = [this](const rclcpp::Parameter & p) {RCLCPP_INFO(this->get_logger(), "cb: Received an update to parameter \"%s\" of type %s: \"%ld\"",p.get_name().c_str(),p.get_type_name().c_str(),p.as_int());};cb_handle_ = param_subscriber_->add_parameter_callback("age", cb);}private:std::shared_ptr<rclcpp::ParameterEventHandler> param_subscriber_;std::shared_ptr<rclcpp::ParameterCallbackHandle> cb_handle_;
};int main(int argc, char ** argv)
{rclcpp::init(argc, argv);rclcpp::spin(std::make_shared<SampleNodeWithParameters>());rclcpp::shutdown();return 0;
}

2.1 上面关键代码说明

包引用:

代码引用 rclcpp 接口提供的各种功能,包括 ParameterEventHandler 类。#include <memory>#include "rclcpp/rclcpp.hpp"

在类声明之后,代码定义了一个类,SampleNodeWithParameters.该类的构造函数声明一个整数参数 age ,默认值为 0。接下来,代码创建一个ParameterEventHandler将用于监视参数更改的 。最后,代码创建一个 lambda 函数并将其设置为每当 age 更新时调用的回调。

注意数据类型定义 :在这里插入图片描述

保存返回的句柄非常重要add_parameter_callback;否则,回调将无法正确注册。

接下来SampleNodeWithParameters是一个典型的main函数,它初始化 ROS,示例节点以便它可以发送和接收消息,然后在用户在控制台输入 Ctrl +C 后关闭。

int main(int argc, char ** argv)
{rclcpp::init(argc, argv);rclcpp::spin(std::make_shared<SampleNodeWithParameters>());rclcpp::shutdown();return 0;
}

在调用rclcpp::spin时,实际上就调用了单线程节点执行器

2.2 添加可执行文件

要构建此代码,首先打开文件CMakeLists.txt并在依赖项下方添加以下代码行find_package(rclcpp REQUIRED)

add_executable(parameter_event_handler src/parameter_event_handler.cpp)
ament_target_dependencies(parameter_event_handler rclcpp)install(TARGETSparameter_event_handlerDESTINATION lib/${PROJECT_NAME}
)

在这里插入图片描述

3. 构建并运行

在构建之前,最好rosdep在工作区的根目录 ( ros2_study) 中运行以检查是否缺少依赖项:

rosdep install -i --from-path src --rosdistro $ROS_DISTRO -y

构建新包

colcon build --packages-select cpp_parameter_event_handler

回顾--packages-select 指定这个包构建

构建成功如下图
在这里插入图片描述

运行:

打开一个新终端,导航到ros2_study并获取安装文件:

. install/setup.bash

运行节点:

ros2 run cpp_parameter_event_handler parameter_event_handler

该节点现在处于活动状态并且具有单个参数,并且每当该参数更新时都会打印一条消息。要测试这一点,请打开另一个终端并像以前一样获取 ROS 安装文件 (.install/setup.bash),然后执行以下命令:

ros2 param set node_with_parameters age  18

运行该节点的终端将显示类似以下内容的消息:

在这里插入图片描述
我们之前在节点中设置的回调已被调用并显示了新的更新值。您现在可以在终端中使用 Ctrl+ C 终止正在运行的parameter_event_handler 示例。

3.1 从另外一个节点监听

您还可以使用 ParameterEventHandler 来监视另一个节点参数的参数更改。让我们更新 SampleNodeWithParameters 类,以监视另一个节点中参数的更改。我们将使用parameter_blackboard演示应用程序来托管我们将监视其更新的双参数。

首先更新构造函数,在现有代码后面添加以下代码:

   auto cb2 = [this](const rclcpp::Parameter & p) {RCLCPP_INFO(this->get_logger(), "cb2: Received an update to parameter \"%s\" of type: %s: \"%.02lf\"",p.get_name().c_str(),p.get_type_name().c_str(),p.as_double());};auto remote_node_name = std::string("parameter_blackboard");auto remote_param_name = std::string("price");cb_handle2_ = param_subscriber_->add_parameter_callback(remote_param_name, cb2, remote_node_name);

重新编译:

colcon build --packages-select cpp_parameter_event_handler

在这里插入图片描述

然后获取安装文件:

. install/setup.bash

现在,要测试远程参数的监控,首先运行新建的parameter_event_handler代码:

ros2 run cpp_parameter_event_handler parameter_event_handler

接下来,从另一个终端(已初始化 ROS)运行parameter_blackboard 演示应用程序,如下所示:

ros2 run demo_nodes_cpp parameter_blackboard

执行此命令后,您应该在parameter_event_handler窗口中看到输出,表明在参数更新时调用了回调函数

最后,从第三个终端(已初始化 ROS),让我们在parameter_blackboard 节点上设置一个参数:

ros2 param set parameter_blackboard price  3.45

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

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

相关文章

Oracle索引详解

1.索引 1.1 索引 索引是建立在表的一列或多个列上的辅助对象&#xff0c;目的是加快访问表中的数据&#xff1b;Oracle存储索引的数据结构是 B 树&#xff0c;位图索引也是如此&#xff0c;只不过是叶子节点不同B数索引&#xff1b;索引由根节点、分支节点和叶子节点组成&…

Linux系统安全与应用【一】

目录 1.账号安全控制 1.1 系统账号清理 1.2 密码安全控制 1.3 命令历史限制 1.4 命令总结 2.系统引导和登录控制 2.1 使用su命令切换用户 2.2 限制使用su命令的用户 3.可插拔式认证模块PAM 3.1 linux中的PAM安全认证 3.2 PAM认证原理​编辑 3.3 PAM认证的构成 3.4 P…

itables, Python 大型数据集显示工具

目录 前言 安装 特性 基本功能 显示表格 排序功能 搜索功能 分页显示 高级功能 自定义列的显示格式 高级搜索功能 实现数据的动态更新 集成外部JavaScript库 总结 前言 iTables库是Python中一个强大的工具&#xff0c;专门用于在Jupyter Notebook和其他IPython环境中以交…

和泽彬一起创建的知识星球——AI交叉知识图谱领域

欢迎来到「AI星图」— 一个专注于人工智能与知识图谱交叉领域的知识社区&#xff01;在这里&#xff0c;我们汇集了来自全球的AI研究者、数据科学家以及行业实践者&#xff0c;共同探索数据的深层链接和智能的未来。 我们的特色亮点&#xff1a; 我们的亮点&#xff1a; 1 精…

All in One mini主机搭建全屋主路由方案----自己实现自己的路由器,实现路由器自由!

1 接线 首先&#xff0c;需要保证家里当前状态是有网的状态&#xff08;路由器有网并正常工作&#xff09; 将鼠标键盘接在mini主机的USB口&#xff0c;HDMP/DP/VGA等接上显示器。从路由器的lan口接一根网线出来接在mini主机的ETH0上&#xff0c;接在mini主机上保证mini主机在…

Leetcode—1329. 将矩阵按对角线排序【中等】(unordered_map、priority_queue)

2024每日刷题&#xff08;121&#xff09; Leetcode—1329. 将矩阵按对角线排序 实现代码 class Solution { public:vector<vector<int>> diagonalSort(vector<vector<int>>& mat) {const int m mat.size();const int n mat[0].size();unorder…

OceanBase 分布式数据库【信创/国产化】- OceanBase 集群配置项

本心、输入输出、结果 文章目录 OceanBase 分布式数据库【信创/国产化】- OceanBase 集群配置项前言OceanBase 数据更新架构OceanBase 集群配置项OceanBase 配置项级别配置项的生效方式查看配置项的级别和生效方式OceanBase 分布式数据库【信创/国产化】- OceanBase 集群配置项…

主流的虚拟机推荐

昨天提到微软与 IBM 合作在 MIT 许可证下发布了 MS-DOS 4.00 的源代码。此次发布的源代码包含了 MS-DOS 4.00 Beta版源码以及相关编译文档。 地址&#xff1a;https://blog.csdn.net/bugsycrack/article/details/138267118?spm1001.2014.3001.5501 感兴趣的人可以在各种虚拟…

【Spring AI】04. 转录 API-OpenAI

文章目录 OpenAI 转录功能先决条件自动装配&#xff08;Auto-configuration &#xff09;转录选项参数 运行时选项参数手动配置示例代码 OpenAI 转录功能 Spring AI 支持 OpenAI 的转录模型。 先决条件 您需要使用 OpenAI 创建一个 API 才能访问 ChatGPT 模型。在 OpenAI 注册…

【Vue】监听div宽高的变化(动态渲染echarts宽高)

一、问题 echarts 未监听到 echarts 宽高变化而动态变化 <template> <div id"echart" ref"echart" style"width: 100%; height: 300px"></div> </div> </template> <script> export default { data() {…

R语言--图形绘制

一&#xff0c;绘制简单图形 c1<- c(10,20,30,40,50) c2<-c(2,7,15,40,50) plot(c1,c2,typeb) 具体参数请参考R语言中的绘图技巧1&#xff1a;plot()函数参数汇总_r语言plot参数设置-CSDN博客 c1<- c(10,20,30,40,50) c2<-c(2,7,15,40,50) plot(c1,c2,typeb,col#…

这些小众工作软件让你事半功倍

大家好&#xff0c;我是追求高效工作的小红书种草小能手&#xff01;今天要和大家分享几款超实用的工作软件&#xff0c;它们可能不像那些大牌软件那样家喻户晓&#xff0c;但绝对能让你的工作生活焕然一新&#xff01;&#x1f31f; 1️⃣《亿可达》- &#x1f5a5;️自动化办…

中信银行深耕养老金融,构建多支柱养老金体系新格局

在应对人口老龄化这一全球性挑战的过程中&#xff0c;养老金融已成为中国金融领域的重要篇章。2024年4月25日&#xff0c;中信银行行长刘成在财新传媒主办的“2024中国养老产业论坛”上发表主旨演讲&#xff0c;深入阐述了养老金金融、养老服务金融、养老产业金融互促互进的大趋…

第8章 软件工程

一、软件工程概述 &#xff08;一&#xff09;软件危机 1、含义&#xff1a;落后的软件生产方式无法满足迅速增长的计算机软件需求&#xff0c;从而导致软件开发与维护过程中出现一系列严重问题的现象。 2、解决方案&#xff1a;引入软件工程的思想。 &#xff08;二&#x…

【Qt】无法创建或打开CMake项目

无法创建或打开CMake项目 没有CMake选项 原因 卸载重装了qt&#xff0c;安装时勾选了cmake&#xff0c;发现还是一样没有。。。 后面发现是插件里没有勾选上CMake。。。很无语 不是应该默认就有的吗 不懂了 解决 插件勾选重启就好了

加密,解密 crypto-js、 计算哈希值,js-sha3

加密&#xff0c;解密 crypto-js、 计算哈希值&#xff0c;js-sha3 文章目录 加密&#xff0c;解密 crypto-js、 计算哈希值&#xff0c;js-sha3crypto-js安装 crypto-js使用 crypto-js js-sha3安装 js-sha3使用 js-sha3 在项目中一些不能明文传输&#xff0c;就需要把明文进行…

Java List 获取部分组成new list,获取两个list相同/不同的内容

获取List中的一项 List<String> _outingCntry list.stream().map(OSzItem::getGroup). collect(Collectors.toList()); 获取List中的多项 List<vo> list new ArrayList<>(); Map<String, String> map list.stream().collect( Collectors.toMap(v…

Python 操作PDF图片 – 添加、替换、删除PDF中的图片

PDF文件中的图片可以丰富文档内容&#xff0c;提升用户的阅读体验。除了在PDF中添加图片外&#xff0c;有时也需要替换或删除其中的图片&#xff0c;以改进视觉效果或更新信息。文本将提供以下三个示例&#xff0c;介绍如何使用Python 操作PDF文件中的图片&#xff1a; 目录 …

qt学习篇---界面按键关联(信号和槽)

目录 1.qt基础 2.做一个界面 创建project UI界面设计 信号和槽 1.控件改名字 2.什么是信号和槽 3.怎么关联信号和槽 自动关联 手动关联 1.qt基础 qt可移植性强&#xff0c;不久会用到MCU。很有意义学习 2.做一个界面 创建project 不要中文路径 选择QWidget .pro文件…

机器学习之K-medians聚类

K-medians聚类是一种聚类算法,类似于K-means,但是它使用中位数来确定簇的中心,而不是平均值。这种方法在处理数据中存在离群值或异常值时比较有用,因为中位数对离群值不敏感。K-medians的步骤与K-means类似,但在每次迭代中,它使用中位数来更新簇的中心。 K-medians的算法…