当前位置:   article > 正文

【ROS2大白话】四、ROS2非常简单的传参方式

【ROS2大白话】四、ROS2非常简单的传参方式

系列文章目录

【ROS2大白话】一、ROS2 humble及cartorgrapher安装
【ROS2大白话】二、turtlebot3安装
【ROS2大白话】三、给turtlebot3安装realsense深度相机
【ROS2大白话】四、ROS2非常简单的传参方式



前言

很多时候,我们需要给ros节点传参数,参数一般写在launch文件或者yaml文件中,不会写在应用开发代码中,原因主要是编译比较费时。本节提供两种非常简便适用的传参方法,一个是launch文件写参数,一个是yaml文件写参数。一看就会,一学就废。


一、launch文件传参的demo

  • package名:hello_ros
  • executable名: demo_pub
  • node名: demo_pub

注意,你自己创建包的时候如果没有按照上述名字来写的话,那你记得拷贝代码时改成自己的名称

这个demo中,我们是直接在launch文件中写入了一个rgb_topic的参数,赋值为’/camera/color/image_raw’

然后通过node节点来读取参数rgb_topic。读取的方法用的是rclcpp::NodeOptions方法。这个声明参数的方法相较于传统的declare_parameter、get_parameter操作更加简单,大家可以尝试一下。

1. 编写launch.py文件

import os
from ament_index_python.packages import get_package_share_directory

from launch import LaunchDescription
from launch_ros.actions import Node

# 方法一、直接在launch文件中写参数
def generate_launch_description():

   return LaunchDescription([
      Node(
         package='hello_ros',
         executable='demo_pub',
         name='demo_pub',
         output='screen',
         parameters=[{'rgb_topic':'/camera/color/image_raw'},{'depth_topic':'/camera/depth/image_raw'}]
      )
   ])
  • 1
  • 2
  • 3
  • 4
  • 5
  • 6
  • 7
  • 8
  • 9
  • 10
  • 11
  • 12
  • 13
  • 14
  • 15
  • 16
  • 17
  • 18

2. 编写C++代码

#include <rclcpp/rclcpp.hpp>
#include "std_msgs/msg/string.hpp"

int main(int argc, char **argv)
{
    rclcpp::init(argc, argv);

    // 传参 方法一
    rclcpp::NodeOptions nodeOptions;
    nodeOptions.automatically_declare_parameters_from_overrides(true);
    auto node2 = rclcpp::Node::make_shared("node2", nodeOptions);
    std::string rgb_topic;
    node2->get_parameter("rgb_topic", rgb_topic);
    printf("===> %s \n", rgb_topic.c_str());

    // 单线程执行器 灵活管理node节点,非堵塞
    rclcpp::executors::SingleThreadedExecutor executor;
    executor.add_node(node2);
    std::thread([&executor]()
                { executor.spin(); })
        .detach();
        
    // rclcpp::spin(node2);
    std::cout << "1111111111111" << std::endl;
    
    rclcpp::shutdown();
    return 0;
}
  • 1
  • 2
  • 3
  • 4
  • 5
  • 6
  • 7
  • 8
  • 9
  • 10
  • 11
  • 12
  • 13
  • 14
  • 15
  • 16
  • 17
  • 18
  • 19
  • 20
  • 21
  • 22
  • 23
  • 24
  • 25
  • 26
  • 27
  • 28

代码里用了ros2的单线程执行器SingleThreadedExecutor,它可以解决传统的spin阻塞问题。假如你用

rclcpp::spin(node2);
  • 1

那么后续的1111111111111打印就一直不会执行。

3. 编写CMakeLists.txt

cmake_minimum_required(VERSION 3.5)
project(hello_ros)
# 启用C++14
add_compile_options(-std=c++14)

# 查找ROS2包
find_package(ament_cmake REQUIRED)
find_package(rclcpp REQUIRED)

# 包含头文件目录
include_directories(include
        )
# ------------------------------------------------------

# 添加可执行文件
add_executable(demo_pub src/demo_pub.cpp)

# 链接依赖库
ament_target_dependencies(demo_pub
        rclcpp
        sensor_msgs
        cv_bridge
        )
# ------------------------------------------------------
# 安装可执行文件
install(TARGETS
         demo_pub
        DESTINATION lib/${PROJECT_NAME}
        )
# 安装其他文件,如参数文件、启动文件等
install(DIRECTORY
        launch
        config
        DESTINATION share/${PROJECT_NAME}
        )
# 导出依赖信息
ament_package()
  • 1
  • 2
  • 3
  • 4
  • 5
  • 6
  • 7
  • 8
  • 9
  • 10
  • 11
  • 12
  • 13
  • 14
  • 15
  • 16
  • 17
  • 18
  • 19
  • 20
  • 21
  • 22
  • 23
  • 24
  • 25
  • 26
  • 27
  • 28
  • 29
  • 30
  • 31
  • 32
  • 33
  • 34
  • 35
  • 36
  • 37

4. 编写package.xml

<?xml version="1.0"?>
<?xml-model href="http://download.ros.org/schema/package_format3.xsd" schematypens="http://www.w3.org/2001/XMLSchema"?>
<package format="3">
  <name>hello_ros</name>
  <version>0.0.0</version>
  <description>TODO: Package description</description>
  <maintainer email="yab@todo.todo">yab</maintainer>
  <license>TODO: License declaration</license>

  <buildtool_depend>ament_cmake</buildtool_depend>

  <depend>rclcpp</depend>

  <test_depend>ament_lint_auto</test_depend>
  <test_depend>ament_lint_common</test_depend>

  <export>
    <build_type>ament_cmake</build_type>
  </export>
</package>

  • 1
  • 2
  • 3
  • 4
  • 5
  • 6
  • 7
  • 8
  • 9
  • 10
  • 11
  • 12
  • 13
  • 14
  • 15
  • 16
  • 17
  • 18
  • 19
  • 20
  • 21

在这里插入图片描述

运行结果跟launch文件里的参数一致。

二、yaml文件传参的demo

代码文件结构跟上个demo的区别就是新增了一个config文件夹和config.yaml文件

1. 编写launch.py文件

import os

from ament_index_python.packages import get_package_share_directory

from launch import LaunchDescription
from launch.actions import DeclareLaunchArgument
from launch.substitutions import LaunchConfiguration
from launch_ros.actions import Node

# 方法二、在yaml文件中写参数,利用launch文件来加载yaml文件
def generate_launch_description():
   config_path = os.path.join(
      get_package_share_directory('hello_ros'),
      'config',
      'config.yaml'
      )
   
   declare_param_file_cmd=DeclareLaunchArgument(
      'param_file',
      default_value= config_path
      # 'Full path to the ROS2 parameters file'
   )

   return LaunchDescription([
      declare_param_file_cmd,
      Node(
         package='hello_ros',
         executable='demo_pub',
         name='demo_pub',
         output='screen',
         parameters=[LaunchConfiguration('param_file')]
      )
   ])
  • 1
  • 2
  • 3
  • 4
  • 5
  • 6
  • 7
  • 8
  • 9
  • 10
  • 11
  • 12
  • 13
  • 14
  • 15
  • 16
  • 17
  • 18
  • 19
  • 20
  • 21
  • 22
  • 23
  • 24
  • 25
  • 26
  • 27
  • 28
  • 29
  • 30
  • 31
  • 32
  • 33

为了读取yaml文件,所以launch文件中增加了几个配置,分别是DeclareLaunchArgumentLaunchConfiguration

  • DeclareLaunchArgument是加载yaml配置文件路径
  • LaunchConfiguration是把加载完的yaml文件进行解析

2. 编写config.yaml文件

yaml文件内容结构是 node名称、ros__parameters、自定义的参数名。其中ros__parameters的下划线是两个下划线组合,千万要注意,不然会报错。(我就是被这个小问题困扰了很久)

特别注意:yaml文件结构一定要完全一样

demo_pub:
  ros__parameters:
    rgb_topic: "ryan"
  • 1
  • 2
  • 3

3. 编写C++代码

#include <rclcpp/rclcpp.hpp>
#include "std_msgs/msg/string.hpp"

int main(int argc, char **argv)
{
    rclcpp::init(argc, argv);
    
    // 传参 方法二
    rclcpp::NodeOptions nodeOptions;
    nodeOptions.automatically_declare_parameters_from_overrides(true);
    auto node_parameter=rclcpp::Node::make_shared("demo_pub", nodeOptions);
    std::string rgb_topic;
    node_parameter->get_parameter("rgb_topic", rgb_topic);
    printf("===> %s \n", rgb_topic.c_str());

    // 单线程执行器 灵活管理node节点,非堵塞
    rclcpp::executors::SingleThreadedExecutor executor;
    executor.add_node(node_parameter);
    std::thread([&executor]()
                { executor.spin(); })
        .detach();
        
    rclcpp::shutdown();
    return 0;
}
  • 1
  • 2
  • 3
  • 4
  • 5
  • 6
  • 7
  • 8
  • 9
  • 10
  • 11
  • 12
  • 13
  • 14
  • 15
  • 16
  • 17
  • 18
  • 19
  • 20
  • 21
  • 22
  • 23
  • 24
  • 25

4. 同上

CMakeLists.txt和package.xml跟上一个demo完全一样,这里就不贴了。

在这里插入图片描述
运行结果跟config.yaml中的一样


觉得对您有帮助的,可以点个赞

声明:本文内容由网友自发贡献,不代表【wpsshop博客】立场,版权归原作者所有,本站不承担相应法律责任。如您发现有侵权的内容,请联系我们。转载请注明出处:https://www.wpsshop.cn/w/小丑西瓜9/article/detail/695238
推荐阅读
相关标签