机器人系统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,一经查实,立即删除!

相关文章

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环境中以交…

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…

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;️自动化办…

第8章 软件工程

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

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

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

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文件…

强力的应用容器引擎---------Docker的资源控制

目录 一、CPU 资源控制 1.1cgroups有四大功能 1.2设置CPU使用率上限 1.2.1查看CPU使用率 1.2.2进行CPU压力测试 1.2.3设置50%的比例分配CPU使用时间上限 1.3设置CPU资源占用比&#xff08;设置多个容器时才有效&#xff09; 1.3.1创建两个容器为hua1 和hua2&#xff0c…

限流--4种经典限流算法讲解--单机限流和分布式限流的实现

为什么需要限流 系统的维护使用是需要成本的&#xff0c;用户可能使用科技疯狂刷量&#xff0c;消耗系统资源&#xff0c;出现额外的经济开销问题&#xff1a; 控制成本>限制用户的调用次数用户在短时间内疯狂使用&#xff0c;导致服务器资源被占满&#xff0c;其他用户无…

Q1季度方便速食行业线上市场(京东天猫淘宝)销售数据分析

方便食品行业作为快速消费品市场的重要组成部分&#xff0c;近几年表现出较为强劲的发展势头。当然&#xff0c;每年的食品安全问题也在一定程度上影响着市场的良性健康发展。那么&#xff0c;今年Q1季度方便食品的线上发展如何&#xff1f; 根据鲸参谋数据显示&#xff0c;Q1…

制造企业如何打造客户服务核心竞争力?[AMT企源典型案例]

引言 产品同质化严重&#xff0c;竞争的焦点从产品转向服务&#xff0c;企业的管理模式也要相应转变。那么如何打造围绕服务的核心竞争力&#xff1f;相信以下案例会给大家一些启发。 项目背景&#xff1a; 售后服务在市场竞争中的作用凸显 A公司是一家医疗器械生产制造企业…

kali 网络环境设置

一、修改网卡配置 1.1 系统桌面上单击右键&#xff0c;在弹出的菜单中选择 Open Terminal Here。 1.2 输入命令 vim /etc/network/interfaces&#xff0c;显示配置网卡参数为。iface lo 一般指 本地环回接口&#xff0c; iface eth0 网卡为系统正在使用的网卡&#xff0c;其中的…

浏览器的本地存储---localstorage

web存储对象 Web 存储对象 localStorage 和 sessionStorage 允许我们在浏览器上保存键/值对。 这两个对象保存再本地&#xff08;客户端&#xff09;&#xff0c;允许保存至少 5MB 的数据&#xff08;或更多&#xff09;&#xff0c;这些数据不会因为页面刷新而销毁&#xff0…

高扬程水泵的性能与应用领域 /恒峰智慧科技

在现代社会中&#xff0c;科技的发展为我们的生活带来了无数便利和可能性。其中&#xff0c;高扬程水泵作为一种高效能的水泵&#xff0c;其独特的设计使其在各个领域都有着广泛的应用&#xff0c;尤其是在森林消防中。 一、高扬程水泵的性能 1. 高扬程&#xff1a;高扬程水泵…

TinyML之Hello world----基于Arduino Nano 33 BLE Sense Rev2的呼吸灯

早期版本的Hello World 这应该是一个逼格比较高的呼吸灯了&#xff0c;用ML来实现呼吸灯功能&#xff0c;之前已经有大佬发过类似的文章&#xff1a;https://blog.csdn.net/weixin_45116099/article/details/126310816 当前版本的Hello World 这是一个ML的入门例程&#xff…

常见面试题总结

1. 苍穹外卖的模块 苍穹外卖大方向上主要分为管理端和用户端 管理端使用vue开发&#xff0c;主要是商家来使用&#xff0c;提供餐品的管理功能&#xff0c;主要有下面几个模块&#xff1a; 员工模块&#xff0c;提供员工账号的登录功能和管理功能 分类、菜品、套餐模块&…

promise笔记

1.介绍 之前的异步编程都是回调函数&#xff08;数据库操作、ajax、定时器、fs读取文件 &#xff09; promise是es6异步编程新的解决方案&#xff0c;是一个构造函数 优点&#xff1a;支持链式调用&#xff0c;可以解决回调地狱&#xff0c;可以指定回调函数 2.使用 functio…

SpringCloud之负载均衡Ribbon

Ribbon 是一个客户端负载均衡工具&#xff0c;主要功能是将面向服务的Rest模板&#xff08;RestTemplate&#xff09;请求转换成客户端负载均衡的服务调用。通过Ribbon&#xff0c;开发人员可以在客户端实现请求的负载均衡&#xff0c;而无需单独部署负载均衡器。Ribbon支持多…