Robot Operating System——初探动态配置Parameters

最新推荐文章于 2024-10-02 14:53:38 发布
最新推荐文章于 2024-10-02 14:53:38 发布
阅读量1.2k 收藏 25
点赞数 39
分类专栏： Robot Operating System 文章标签： 机器人 c++
版权声明：本文为博主原创文章，遵循 CC 4.0 BY-SA 版权协议，转载请附上原文出处链接和本声明。
本文链接：https://blog.csdn.net/breaksoftware/article/details/140587898
版权

大纲

当我们程序写完后，如果需要修改程序中的某个配置，可以通过三种方案进行：

  • 通过文件。修改文件内容，并让程序动态加载这个文件，进而动态修改配置。
  • 通过网路。可以通过网络接口，让程序暴露一些接口用于修改其内部配置。
  • 通过进程间通信。对于在一台机器上的进程，可以通过进程间通信，通知程序修改配置。

而在ROS 2中，它提供了一种叫做Parameters的技术，辅助我们快速修改配置。

需要注意的是，在ROS 2中，配置是和Node相关的，即Parameter从属于Node。

我们通过demo_nodes_cpp/src/parameters/set_and_get_parameters.cpp和demo_nodes_cpp/src/parameters/set_and_get_parameters_async.cpp的例子来讲解如何在外部设置、获取一个Node上的Parameters。

同步模式

我们在一个叫set_and_get_parameters的Node中做相关实验（demo_nodes_cpp/src/parameters/set_and_get_parameters.cpp）。这样我们就可以直接使用继承于Node的方法来操作。

需要注意的是，Node自身也是一个设置/获取Parameters值的服务端。后面我们会看到如何使用客户端来向这个服务端来设置和查询Parameters的值。

class SetAndGetParameters : public rclcpp::Node
{
public:
  DEMO_NODES_CPP_PUBLIC
  explicit SetAndGetParameters(const rclcpp::NodeOptions & options)
  : Node("set_and_get_parameters", options)
  {
    setvbuf(stdout, NULL, _IONBF, BUFSIZ);

Node内使用declare_parameter方法声明Parameters

Node的declare_parameter方法用于设置一些parameter的Key和Value。

    this->declare_parameter("foo", 0);
    this->declare_parameter("bar", "");
    this->declare_parameter("baz", 0.);
    this->declare_parameter("foobar", false);
    this->declare_parameter("foobarbaz", std::vector<bool>{});
    this->declare_parameter("toto", std::vector<uint8_t>{});

创建Parameter同步访问客户端

构建rclcpp::SyncParametersClient时，我们传入的this指针就是即将创建的客户端要访问的Node节点。

    auto parameters_client = std::make_shared<rclcpp::SyncParametersClient>(this);
    while (!parameters_client->wait_for_service(1s)) {
      if (!rclcpp::ok()) {
        RCLCPP_ERROR(this->get_logger(), "Interrupted while waiting for the service. Exiting.");
        rclcpp::shutdown();
      }
      RCLCPP_INFO(this->get_logger(), "service not available, waiting again...");
    }

SyncParametersClient有三个参数。如果只指定了Node节点，说明这个节点是在我们程序内部创建的。这样就不需要跨网络，而是可以直接启动一个线程来访问，形成异步请求。

  template<typename NodeT>
  explicit SyncParametersClient(
    std::shared_ptr<NodeT> node,
    const std::string & remote_node_name = "",
    const rclcpp::QoS & qos_profile = rclcpp::ParametersQoS())
  : SyncParametersClient(
      std::make_shared<rclcpp::executors::SingleThreadedExecutor>(),
      node,
      remote_node_name,
      qos_profile)
  {}

跨Node修改Parameters

SyncParametersClient的set_parameters接收一个rclcpp::Parameter组成的vector，返回表达操作结果的std::vector<rcl_interfaces::msg::SetParametersResult>。我们可以遍历这个返回结果，查看哪个设置失败了。

    // Set several different types of parameters.
    auto set_parameters_results = parameters_client->set_parameters(
      {
        rclcpp::Parameter("foo", 2),
        rclcpp::Parameter("bar", "hello"),
        rclcpp::Parameter("baz", 1.45),
        rclcpp::Parameter("foobar", true),
        rclcpp::Parameter("foobarbaz", std::vector<bool>({true, false})),
        rclcpp::Parameter("toto", std::vector<uint8_t>({0xff, 0x7f})),
      });
    // Check to see if they were set.
    for (auto & result : set_parameters_results) {
      if (!result.successful) {
        RCLCPP_ERROR(this->get_logger(), "Failed to set parameter: %s", result.reason.c_str());
      }
    }

跨Node查询Parameters

SyncParametersClient的get_parameters方法也接收一个由Key做成的vector。我们可以通过它来查询到该客户端连接的Node中，这些Key对应的Value。

    std::stringstream ss;
    // Get a few of the parameters just set.
    for (
      auto & parameter : parameters_client->get_parameters(
        {"foo", "baz", "foobarbaz", "toto"}))
    {
      ss << "\nParameter name: " << parameter.get_name();
      ss << "\nParameter value (" << parameter.get_type_name() << "): " <<
        parameter.value_to_string();
    }
    RCLCPP_INFO(this->get_logger(), "%s", ss.str().c_str());

完整代码

// Copyright 2015 Open Source Robotics Foundation, Inc.
//
// Licensed under the Apache License, Version 2.0 (the "License");
// you may not use this file except in compliance with the License.
// You may obtain a copy of the License at
//
//     http://www.apache.org/licenses/LICENSE-2.0
//
// Unless required by applicable law or agreed to in writing, software
// distributed under the License is distributed on an "AS IS" BASIS,
// WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
// See the License for the specific language governing permissions and
// limitations under the License.

#include <chrono>
#include <memory>
#include <sstream>
#include <vector>

#include "rclcpp/rclcpp.hpp"
#include "rclcpp_components/register_node_macro.hpp"

#include "demo_nodes_cpp/visibility_control.h"

using namespace std::chrono_literals;

namespace demo_nodes_cpp
{

class SetAndGetParameters : public rclcpp::Node
{
public:
  DEMO_NODES_CPP_PUBLIC
  explicit SetAndGetParameters(const rclcpp::NodeOptions & options)
  : Node("set_and_get_parameters", options)
  {
    setvbuf(stdout, NULL, _IONBF, BUFSIZ);
    this->declare_parameter("foo", 0);
    this->declare_parameter("bar", "");
    this->declare_parameter("baz", 0.);
    this->declare_parameter("foobar", false);
    this->declare_parameter("foobarbaz", std::vector<bool>{});
    this->declare_parameter("toto", std::vector<uint8_t>{});

    auto parameters_client = std::make_shared<rclcpp::SyncParametersClient>(this);
    while (!parameters_client->wait_for_service(1s)) {
      if (!rclcpp::ok()) {
        RCLCPP_ERROR(this->get_logger(), "Interrupted while waiting for the service. Exiting.");
        rclcpp::shutdown();
      }
      RCLCPP_INFO(this->get_logger(), "service not available, waiting again...");
    }

    // Set several different types of parameters.
    auto set_parameters_results = parameters_client->set_parameters(
      {
        rclcpp::Parameter("foo", 2),
        rclcpp::Parameter("bar", "hello"),
        rclcpp::Parameter("baz", 1.45),
        rclcpp::Parameter("foobar", true),
        rclcpp::Parameter("foobarbaz", std::vector<bool>({true, false})),
        rclcpp::Parameter("toto", std::vector<uint8_t>({0xff, 0x7f})),
      });
    // Check to see if they were set.
    for (auto & result : set_parameters_results) {
      if (!result.successful) {
        RCLCPP_ERROR(this->get_logger(), "Failed to set parameter: %s", result.reason.c_str());
      }
    }

    std::stringstream ss;
    // Get a few of the parameters just set.
    for (
      auto & parameter : parameters_client->get_parameters(
        {"foo", "baz", "foobarbaz", "toto"}))
    {
      ss << "\nParameter name: " << parameter.get_name();
      ss << "\nParameter value (" << parameter.get_type_name() << "): " <<
        parameter.value_to_string();
    }
    RCLCPP_INFO(this->get_logger(), "%s", ss.str().c_str());

    rclcpp::shutdown();
  }
};

}  // namespace demo_nodes_cpp

RCLCPP_COMPONENTS_REGISTER_NODE(demo_nodes_cpp::SetAndGetParameters)

运行结果

./build/demo_nodes_cpp/set_and_get_parameters

在这里插入图片描述
可以看到查询到的值都是修改后的值。

异步模式

我们参考demo_nodes_cpp/src/parameters/set_and_get_parameters_async.cpp的例子，看看异步设置和查询Parameters是如何做到的。

创建Node，设置Parameters

这次我们不在Node中执行逻辑，而是在Main函数中。这样我们就需要创建一个Node，然后给这个Node声明一批Parameters。

int main(int argc, char ** argv)
{
  // Force flush of the stdout buffer.
  setvbuf(stdout, NULL, _IONBF, BUFSIZ);

  rclcpp::init(argc, argv);

  auto node = rclcpp::Node::make_shared("set_and_get_parameters_async");

  // Declare parameters that may be set on this node
  node->declare_parameter("foo", 0);
  node->declare_parameter("bar", "");
  node->declare_parameter("baz", 0.);
  node->declare_parameter("foobar", false);
  node->declare_parameter("foobarbaz", std::vector<bool>{});
  node->declare_parameter("toto", std::vector<uint8_t>{});

创建Parameter异步访问客户端

这次我们创建的对象是rclcpp::AsyncParametersClient，它要操作的Node就是上面我们创建的"set_and_get_parameters_async"。

  auto parameters_client = std::make_shared<rclcpp::AsyncParametersClient>(node);
  while (!parameters_client->wait_for_service(1s)) {
    if (!rclcpp::ok()) {
      RCLCPP_ERROR(node->get_logger(), "Interrupted while waiting for the service. Exiting.");
      return 0;
    }
    RCLCPP_INFO(node->get_logger(), "service not available, waiting again...");
  }

异步设置，同步等待

由于这次是异步设置Parameters，所以我们需要等待set_parameters返回的结果。直到rclcpp::spin_until_future_complete完成了针对上述Node的等待，再遍历这个结构体，查询是不是每个设置都是成功的。

  // Set several different types of parameters.
  auto results = parameters_client->set_parameters(
  {
    rclcpp::Parameter("foo", 2),
    rclcpp::Parameter("bar", "hello"),
    rclcpp::Parameter("baz", 1.45),
    rclcpp::Parameter("foobar", true),
    rclcpp::Parameter("foobarbaz", std::vector<bool>({true, false})),
    rclcpp::Parameter("toto", std::vector<uint8_t>({0xff, 0x7f})),
  });
  // Wait for the results.
  if (rclcpp::spin_until_future_complete(node, results) !=
    rclcpp::FutureReturnCode::SUCCESS)
  {
    RCLCPP_ERROR(node->get_logger(), "set_parameters service call failed. Exiting tutorial.");
    return -1;
  }
  // Check to see if they were set.
  for (auto & result : results.get()) {
    if (!result.successful) {
      RCLCPP_ERROR(node->get_logger(), "Failed to set parameter: %s", result.reason.c_str());
    }
  }

异步查询，同步等待

AsyncParametersClient的get_parameters也是异步请求，返回的是std::vector<rclcpp::Parameter>。我们还是需要使用rclcpp::spin_until_future_complete来等到Node完成此次查询请求。等到查询完成才可以遍历访问查询到的数据。

  auto parameters = parameters_client->get_parameters({"foo", "baz", "foobarbaz", "toto"});
  if (rclcpp::spin_until_future_complete(node, parameters) !=
    rclcpp::FutureReturnCode::SUCCESS)
  {
    RCLCPP_ERROR(node->get_logger(), "get_parameters service call failed. Exiting tutorial.");
    return -1;
  }
  std::stringstream ss;
  for (auto & parameter : parameters.get()) {
    ss << "\nParameter name: " << parameter.get_name();
    ss << "\nParameter value (" << parameter.get_type_name() << "): " <<
      parameter.value_to_string();
  }
  RCLCPP_INFO(node->get_logger(), "%s", ss.str().c_str());

完整代码

// Copyright 2015 Open Source Robotics Foundation, Inc.
//
// Licensed under the Apache License, Version 2.0 (the "License");
// you may not use this file except in compliance with the License.
// You may obtain a copy of the License at
//
//     http://www.apache.org/licenses/LICENSE-2.0
//
// Unless required by applicable law or agreed to in writing, software
// distributed under the License is distributed on an "AS IS" BASIS,
// WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
// See the License for the specific language governing permissions and
// limitations under the License.

#include <chrono>
#include <memory>
#include <sstream>
#include <vector>

#include "rclcpp/rclcpp.hpp"

using namespace std::chrono_literals;

int main(int argc, char ** argv)
{
  // Force flush of the stdout buffer.
  setvbuf(stdout, NULL, _IONBF, BUFSIZ);

  rclcpp::init(argc, argv);

  auto node = rclcpp::Node::make_shared("set_and_get_parameters_async");

  // Declare parameters that may be set on this node
  node->declare_parameter("foo", 0);
  node->declare_parameter("bar", "");
  node->declare_parameter("baz", 0.);
  node->declare_parameter("foobar", false);
  node->declare_parameter("foobarbaz", std::vector<bool>{});
  node->declare_parameter("toto", std::vector<uint8_t>{});

  auto parameters_client = std::make_shared<rclcpp::AsyncParametersClient>(node);
  while (!parameters_client->wait_for_service(1s)) {
    if (!rclcpp::ok()) {
      RCLCPP_ERROR(node->get_logger(), "Interrupted while waiting for the service. Exiting.");
      return 0;
    }
    RCLCPP_INFO(node->get_logger(), "service not available, waiting again...");
  }

  // Set several different types of parameters.
  auto results = parameters_client->set_parameters(
  {
    rclcpp::Parameter("foo", 2),
    rclcpp::Parameter("bar", "hello"),
    rclcpp::Parameter("baz", 1.45),
    rclcpp::Parameter("foobar", true),
    rclcpp::Parameter("foobarbaz", std::vector<bool>({true, false})),
    rclcpp::Parameter("toto", std::vector<uint8_t>({0xff, 0x7f})),
  });
  // Wait for the results.
  if (rclcpp::spin_until_future_complete(node, results) !=
    rclcpp::FutureReturnCode::SUCCESS)
  {
    RCLCPP_ERROR(node->get_logger(), "set_parameters service call failed. Exiting tutorial.");
    return -1;
  }
  // Check to see if they were set.
  for (auto & result : results.get()) {
    if (!result.successful) {
      RCLCPP_ERROR(node->get_logger(), "Failed to set parameter: %s", result.reason.c_str());
    }
  }

  // Get a few of the parameters just set.
  auto parameters = parameters_client->get_parameters({"foo", "baz", "foobarbaz", "toto"});
  if (rclcpp::spin_until_future_complete(node, parameters) !=
    rclcpp::FutureReturnCode::SUCCESS)
  {
    RCLCPP_ERROR(node->get_logger(), "get_parameters service call failed. Exiting tutorial.");
    return -1;
  }
  std::stringstream ss;
  for (auto & parameter : parameters.get()) {
    ss << "\nParameter name: " << parameter.get_name();
    ss << "\nParameter value (" << parameter.get_type_name() << "): " <<
      parameter.value_to_string();
  }
  RCLCPP_INFO(node->get_logger(), "%s", ss.str().c_str());

  rclcpp::shutdown();

  return 0;
}

总结

本文的两个例子，分别使用SyncParametersClient和AsyncParametersClient从Node外部设置和查询Node的Parameters。实际我们在Node内部可以通过Node类中的set_parameter方法操作本Node的Parameters。
在这里插入图片描述

breaksoftware
关注
专栏目录
robot operating system概述
shlijiapeng的博客
11-18 2436
伴随科学技术发展，人工智能的需求日益增长，机器人领域也迅速发展，响应需求，Willow Garage公司于2010年发布了开源机器人操作系统Ros。
Raspberry Pi 2从裸板到ubuntu14.04，一步一步安装Robot Operating System（机器人操作系统）
Mars_WH的专栏
06-20 9278
Raspberry Pi 2从裸板到ubuntu14.04，一步一步安装Robot Operating System（机器人操作系统）   目录： 1.     Ubuntu 14.04 LTS安装 1.1      操作系统下载 1.2      系统安装 1.3      通过SSH远程访问 1.4      ROOT账号设置 1.5      扩展可用空间 1.6
Robot Operating System——深度解析监控Parameters修改的底层实现
方亮的专栏
07-29 1903
ParameterEventHandler包含了AsyncParametersClient的实现，且比其功能更丰富。AsyncParametersClient只能设置一个全部Parameter监控回调函数，而ParameterEventHandler可以设置多个。而且ParameterEventHandler还可以针对不同Node、不同Parameter设置多个不同的回调，但是AsyncParametersClient没有这个能力。
Robot Operating System——使用VSCode调试ROS2代码
方亮的专栏
08-19 1825
由于ROS2在编译运行前，都要通过下面命令初始化环境而CMake Tools没有设置该行为的机会，我们只能自定义一个文件，然后通过它来代理cmake的执行。然后填入以下内容/bin/bash# 检查是否提供了至少一个参数thenexit 1fi# Source 环境设置脚本# 运行传递进来的 cmake 命令cmake "$@"保存文件后，我们赋予其执行权限。然后将其软链接到/usr/bin目录下后面我就可以使用ros2-cmake来编译我们的ROS2相关的工程了。
ROS1/2最强学术科研参考书-Springer Book Robot Operating System (ROS) The Complete Reference (Volume 7)
zhangrelay的专栏
09-18 1215
地表最强ROS学术科研汇编集。 第一卷下载量超20万+，第三卷下载量超2万+。 热度呈现出明显下滑趋势，何时能止跌回升呢？？？
机器人操作系统 (Robot Operating System，ROS)
既然选择了远方 便只顾风雨兼程 - 永强
03-30 2808
机器人操作系统 (Robot Operating System，ROS) A Gentle Introduction to ROS https://cse.sc.edu/~jokane/agitr/ A Gentle Introduction to ROS https://cse.sc.edu/~jokane/agitr/agitr-letter.pdf Printable version (Formatted for US letter paper. Should work well for two-si
Robot Operating System --- ROS入门学习笔记
芃晟的博客
03-09 6576
目录 一.ROS简介 1.1 简介 1.2 ROS的总体设计 1.3 ROS安装 1.4 ROS的系统实现 二.ROS的文件系统级 2.1 文件系统级的基本概念 2.2 文件系统级中的src目录详解 2.3 创建工作空间和功能包 三.ROS的计算图 计算图级体现的是进程与系统之间的通信，描述程序是如何运行的。 3.1 基本概念 3.2 详解Topic通信机制（适用数据传...
快速了解 Robot Operating System（ROS） 机器人操作系统
热门推荐
zhangrelay的专栏
12-19 1万+
http://www.ros.org/关于ROS About ROS http://www.ros.org/about-ros/机器人操作系统（ROS）是用于编写机器人软件的灵活框架。目的在简化多种机器人平台之间创建复杂和鲁棒的机器人行为的任务量，它是工具、库和约定的集合。为什么这么做？因为创建真正可靠和通用的机器人软件是很困难的。从机器人角度而言，任务和环境的多样性是问题的关键。处理这种多变的任
ROS (Robot Operating System) Tutorials
linuxarmsummary的专栏
08-05 559
ROS (Robot Operating System) Tutorials Table of Contents 1. 安装ROS Indigo 1.1. Install ros-indigo-desktop-full1.2. Initialize rosdep1.3. Environment setup1.4. Getting rosinstall 2. ROS基本概
ROS(Robot Operating System）操作系统探索总结(一)简介
yake827的专栏
01-06 8403
一、历史 　　随着机器人领域的快速发展和复杂化，代码的复用性和模块化的需求原来越强烈，而已有的开源机器人系统又不能很好的适应需求。2010年Willow Garage公司发布了开源机器人操作系统ROS(robot operating system)，很快在机器人研究领域展开了学习和使用ROS的热潮。 　　ROS系统是起源于2007年斯坦福大学人工智能实验室的项目与机器人技术公司Willow
Robot Operating System (ROS) 2.pdf
10-06
参数服务器则用于存储和共享全局配置参数，方便在整个系统中管理配置信息。 ROS的工作流程通常包括几个步骤：首先，开发者编写ROS节点，这些节点实现了特定的算法或功能；接着，利用ROS的工具如`roslaunch`来启动和...
Robot Operating System (ROS) The Complete Reference (Volume 4).pdf
11-05
Robot Operating System (ROS): The Complete Reference (Volume 4) Anis Koubaa This is the fourth volume of the successful series Robot Operating Systems: The Complete Reference, providing a ...
Robot Operating System-开源
07-01
项目已移动！ ROS 现在托管在 https://code.ros.org/gf/project/ros/
ROS（Robot Operating System）安装配置.zip
07-04
ROS（Robot Operating System）安装配置
Robot operating system cookbook
01-03
### Robot Operating System (ROS) Cookbook知识点详述 #### 一、ROS基础知识介绍 **Robot Operating System（ROS）**，即机器人操作系统，并非传统意义上的操作系统，而是一种为机器人软件开发提供的框架。它提供...
手部姿态映射到远程操作机器人
最新发布
weixin_40514381的博客
10-02 471
要将手部姿态数据映射到远程操作机器人，可以使用 Python 和一些库（如mediapipe和numpy）来i简单实现这个功能。以下是一个具体的实现步骤，主要包括手部姿态检测、数据处理和关节位置映射。
新能源汽车储充机器人：能源高效与智能调度
2401_83953933的博客
09-29 405
例如，在高峰时段，机器人会优先为即将耗尽电量的车辆提供充电服务，而在低峰时段，则会为储能设备充电，以备不时之需。储充机器人技术的出现，正是为了解决这一难题，为新能源汽车的广泛应用铺平道路。想象一下，在繁忙的商业区，这些智能设备在无人干预的情况下，自动为停靠在充电站的新能源汽车进行充电。总之，储充机器人的出现不仅为新能源汽车的充电问题提供了创新的解决方案，还为未来能源高效利用与智能调度描绘出一幅美好的蓝图。随着技术的不断进步和应用的不断拓展，我们有理由相信，储充机器人将在未来的能源革命中发挥至关重要的作用。
基于Arduino的自弹尤克里里机器人
weixin_51141489的博客
09-29 1619
在这个充满创意的项目中，我们将一起探索如何使用Arduino Uno微控制器来构建一个可以自主演奏音乐的自弹尤克里里机器人。这是一个结合了3D打印、电子工程和编程的有趣项目，适合所有级别的爱好者。
ROS (Robot Operating System) 教程与关键概念
"ROS (Robot Operating System) 是一个开源操作系统，用于构建机器人软件。它提供了一个框架，使得开发者可以方便地创建和管理机器人应用的各个组件。ROS主要由软件包组成，这些包包含了代码、库、可执行文件等。...
评论
添加红包

请填写红包祝福语或标题

个

红包个数最小为10个

元

红包金额最低5元

当前余额3.43元 前往充值 >
需支付：10.00元
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包

打赏作者

breaksoftware

你的鼓励将是我创作的最大动力

¥1 ¥2 ¥4 ¥6 ¥10 ¥20
扫码支付：¥1
获取中
扫码支付

您的余额不足，请更换扫码支付或充值

打赏作者

实付元
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明：

1.余额是钱包充值的虚拟货币，按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载，可以购买VIP、付费专栏及课程。

余额充值