【ROS2笔记四】ROS2话题通信

最新推荐文章于 2024-05-10 09:31:10 发布
最新推荐文章于 2024-05-10 09:31:10 发布
阅读量1k 收藏 26
点赞数 12
文章标签： c++ 开发语言
版权声明：本文为博主原创文章，遵循 CC 4.0 BY-SA 版权协议，转载请附上原文出处链接和本声明。
本文链接：https://blog.csdn.net/qq_44940689/article/details/137684082
版权

4.ROS2话题通信

文章目录

话题是ROS2中常用的通信方式之一，话题通信采取的是订阅发布模型，一个节点的数据会发布到某个话题之上，然后另一个节点可以订阅这个话题，这个节点就可以通过这个话题来拿到发布节点发布的数据了。

4.1订阅发布模型

订阅发布模型可以是：

  1. 一对一的
  2. 一对多的
  3. 多对一的
  4. 多对多的
  5. 节点可以订阅本身发布的话题内容

4.2ROS2话题工具

运行ROS2自带的demo我们可以简单地使用rqt_graph来查看topic的传递路径

ros2 run demo_nodes_cpp listener
ros2 run demo_nodes_cpp talker
rqt_graph

就可以看到下面的结果

Image

除了rqt_graph之外，ROS2还有一些CLI（Command Line Interface）命令行工具可以使用：

ros2 topic -h

可以查看所有有关topic的CLI的使用方法，这里不再赘述。

4.3rclcpp实现话题

4.3.1编写发布者

（1）创建新的节点

首先，创建一个新的工作空间colcon_test03_ws和新的功能包example_topic_rclcpp（这里旨在回顾工作空间和功能包的创建方法，你也可以在现有的功能包中直接创建脚本文件），然后新建脚本文件topic_publisher_01.cpp

mkdir -p ./colcon_test03_ws/src
cd ./colcon_test03_ws/src
ros2 pkg create example_topic_rclcpp --build-type ament_cmake --license Apache-2.0 --dependencies rclcpp
touch ./example_topic_rclcpp/src/topic_publisher_01.cpp

使用tree命令来查看目录结构（如果没有该命令则需提前安装sudo apt install tree），如下：

.
└── example_topic_rclcpp
    ├── CMakeLists.txt
    ├── include
    │   └── example_topic_rclcpp
    ├── LICENSE
    ├── package.xml
    └── src
        └── topic_publisher_01.cpp

4 directories, 4 files

现在我们需要在这个脚本文件中写入内容了，推荐使用vscode作为编辑器。我们使用面向对象的方式来编写一个最简单的节点，

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

class TopicPublisher01: public rclcpp::Node{
public:
    // 构造函数
    TopicPublisher01(std::string name) : Node(name){
        RCLCPP_INFO(this->get_logger(), "%s node has been launched", name.c_str());
    }
private:

};

int main(int argc, char **argv){
    rclcpp::init(argc, argv);
    auto node = std::make_shared<TopicPublisher01>("topic_publisher_01");
    rclcpp::spin(node);
    rclcpp::shutdown();
    return 0;
}

然后修改CMakeListst.txt，添加依赖

add_executable(topic_publisher_01 src/topic_publisher_01.cpp)
ament_target_dependencies(topic_publisher_01 rclcpp)
install(TARGETS
  topic_publisher_01
  DESTINATION lib/${PROJECT_NAME}
)

（2）导入消息接口

消息接口是ROS2通信时必须的一部分，通过消息接口ROS2才能够完成消息的序列化和反序列化。ROS2为我们定义好了常用的消息接口，并生成了C++和Python的依赖文件，我们可以直接在程序中进行导入。

ament_cmake类型功能包导入消息接口分为三部分：

  1. 在CMakeLists.txt中导入，具体是先find_packages再ament_target_dependencies
  2. 在packages.xml中导入，具体是添加depend标签并将消息接口写入
  3. 在代码中导入，C++中是#inlcude "消息功能包/xxx/xxx.hpp"

这三步修改的文件内容如下：

CMakeLists.txt

find_package(ament_cmake REQUIRED)
find_package(rclcpp REQUIRED)
find_package(std_msgs REQUIRED)

add_executable(topic_publisher_01 src/topic_publisher_01.cpp)
ament_target_dependencies(topic_publisher_01 rclcpp std_msgs)
install(TARGETS
  topic_publisher_01
  DESTINATION lib/${PROJECT_NAME}
)

packages.xml

<buildtool_depend>ament_cmake</buildtool_depend>

<depend>rclcpp</depend>
<depend>std_msgs</depend>

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

如果不想手动在CMakeLists.txt和packages.xml中添加包的依赖，我们可以在创建功能包的时候就添加上--dependencies std_msgs的依赖，这样就会为我们自动添加了。如下：

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

代码文件topic_publisher_01.cpp，包含消息头文件

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

class TopicPublisher01 : public rclcpp::Node

（3）创建发布者Publisher

相关API文档可以参考：https://docs.ros2.org/latest/api/rclcpp/

Image

我们需要指定的参数有：

  • 话题名称（topic_name），我们设置为control_command即可
  • Qos，Qos指定一个数字，这个数字对应的是KeepLast消息队列的长度。
  • 还需要指定函数原型template中MessageT的消息类型（即示例中的MsgT），我们直接设置成std_msgs::msg::String即可。

编写如下的发布者代码

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

class TopicPublisher01: public rclcpp::Node{
public:
    // 构造函数
    TopicPublisher01(std::string name) : Node(name){
        RCLCPP_INFO(this->get_logger(), "%s node has been launched", name.c_str());
        // 创建发布者
        command_publisher_ = this->create_publisher<std_msgs::msg::String>('control_command', 10);
    }
private:
    // 声明话题发布者，在类的私有成员中再次声明发布者对象是为了在整个类中都能够访问和使用该对象。
    rclcpp::Publisher<std_msgs::msg::String>::SharedPtr command_publisher_;
};

int main(int argc, char **argv){
    rclcpp::init(argc, argv);
    auto node = std::make_shared<TopicPublisher01>("topic_publisher_01");
    rclcpp::spin(node);
    rclcpp::shutdown();
    return 0;
}

（4）创建定时器Timer

相关API文档可以参考：https://docs.ros2.org/latest/api/rclcpp/

Image
  • period，回调函数调用的周期
  • callback，回调函数
  • group，调用回调函数所在的回调组，默认为nullptr

编写如下的Timer代码

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

class TopicPublisher01: public rclcpp::Node{
public:
    // 构造函数
    TopicPublisher01(std::string name) : Node(name){
        RCLCPP_INFO(this->get_logger(), "%s node has been launched", name.c_str());
        // 创建发布者
        command_publisher_ = this->create_publisher<std_msgs::msg::String>('control_command', 10);
        // 创建定时器，500ms周期
        timer_ = this->create_wall_timer(std::chrono::milliseconds(500), std::bind(&TopicPublisher01::timer_callback, this));
    }
private:
    // 声明话题发布者，在类的私有成员中再次声明发布者对象是为了在整个类中都能够访问和使用该对象。
    rclcpp::Publisher<std_msgs::msg::String>::SharedPtr command_publisher_;
    // 声明定时器
    rclcpp::TimerBase::SharedPtr timer_;

    void timer_callback(){
        // 创建消息
        std_msgs::msg::String message;
        message.data = "forward";
        // 打印日志
        RCLCPP_INFO(this->get_logger(), "Publishing: '%s'", message.data.c_str());
        // 发布消息
        this->command_publisher_->publish(message);
    }
};

int main(int argc, char **argv){
    rclcpp::init(argc, argv);
    auto node = std::make_shared<TopicPublisher01>("topic_publisher_01");
    rclcpp::spin(node);
    rclcpp::shutdown();
    return 0;
}

测试一下是否正确

colcon build --packages-select example_topic_rclcpp
source ./intsall/setup.bash
ros2 run example_topic_rclcpp topic_publisher_01

使用CLI查看消息内容

ros2 topic list
ros2 topic echo /control_command

4.4编写订阅者

（1）创建订阅节点

cd ./colcon_test03_ws/src
touch ./example_topic_rclcpp/src/topic_subscriber_01.cpp

编写以下内容：

#include "rclcpp/rclcpp.hpp"

class TopicSubscriber01: public rclcpp::Node{
public:
    TopicSubscriber01(std::string name): Node(name){
        RCLCPP_INFO(this->get_logger(), "%s has been launched", name.c_str());
    }

private:
};

int main(int argc, char **argv){
    rclcpp::init(argc, argv);
    auto node = std::make_shared<TopicSubscriber01>("topic_subscriber_01");
    rclcpp::spin(node);
    rclcpp::shutdown();
    return 0;
}

修改CMakeLists.txt文件

add_executable(topic_subscriber_01 src/topic_subscriber_01.cpp)
ament_target_dependencies(topic_subscriber_01 rclcpp std_msgs)

install(TARGETS
  topic_publisher_01
  topic_subscriber_01
  DESTINATION lib/${PROJECT_NAME}
)

然后可以测试运行一下

colcon build --packages-select example_topic_rclcpp
source install/setup.bash
ros2 run example_topic_rclcpp topic_subscriber_01

（2）创建订阅者Subscriber

相关API文档可以参考：https://docs.ros2.org/latest/api/rclcpp/

Image

我们只关心前面三个参数，后面两个参数可以选择默认的参数

  • topic_name，指定订阅的话题名称
  • qos，指定消息队列长度
  • callback，指定订阅后消息处理的回调函数

编写以下代码：

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

class TopicSubscriber01: public rclcpp::Node{
public:
    TopicSubscriber01(std::string name): Node(name){
        RCLCPP_INFO(this->get_logger(), "%s has been launched", name.c_str());
        // 创建一个订阅者
        command_subscriber_ = this->create_subscription<std_msgs::msg::String>("control_command", 10, std::bind(&TopicSubscriber01::command_callback, this, std::placeholders::_1));
    }

private:
    // 声明一个订阅者
    rclcpp::Subscription<std_msgs::msg::String>::SharedPtr command_subscriber_;
    // 消息处理的回调函数
    void command_callback(const std_msgs::msg::String::SharedPtr msg){
        double speed = 0.0f;
        if (msg->data == "forward"){
            speed = 0.2f;
        }
        RCLCPP_INFO(this->get_logger(), "Receive instruction [%s], send speed [%f]", msg->data.c_str(), speed);
    }

};

int main(int argc, char **argv){
    rclcpp::init(argc, argv);
    auto node = std::make_shared<TopicSubscriber01>("topic_subscriber_01");
    rclcpp::spin(node);
    rclcpp::shutdown();
    return 0;
}

构建然后运行

colcon build --packages-select example_topic_rclcpp
source install/setup.bash
ros2 run example_topic_rclcpp topic_publisher_01
ros2 run example_topic_rclcpp topic_subscriber_01

运行后的输出效果类似如下：

[INFO] [1712900021.099703358] [topic_publisher_01]: Publishing: 'forward'
[INFO] [1712900021.599713885] [topic_publisher_01]: Publishing: 'forward'
[INFO] [1712900022.099719858] [topic_publisher_01]: Publishing: 'forward'
[INFO] [1712900022.599664745] [topic_publisher_01]: Publishing: 'forward'


[INFO] [1712900027.600149013] [topic_subscriber_01]: Receive instruction [forward], send speed [0.200000]
[INFO] [1712900028.100186298] [topic_subscriber_01]: Receive instruction [forward], send speed [0.200000]
[INFO] [1712900028.600202891] [topic_subscriber_01]: Receive instruction [forward], send speed [0.200000]

Reference

d2lros2
ROS2 Tutorial

木心
关注
  • 12
    点赞
  • 踩
  • 26
    收藏
    觉得还不错? 一键收藏
  • 打赏
    打赏
  • 1
    评论
ROS2教程（入门级）：理解ROS 2话题（topics）
D109的博客
06-21 1487
目标: 使用rqt_graph和命令行工具讲解ROS 2 的话题（ROS 2 topic）。 背景知识 ROS 2将复杂的系统分见为许多模块化的节点。话题（topics）是ROS graph（图）中非常重要的的组成部分，它像交通工具一样，为各个节点交换信息。 [外链图片转存失败,源站可能有防盗链机制,建议将图片保存下来直接上传(img-kBOOIY2e-1624290284959)(https://docs.ros.org/en/foxy/_images/Topic-SinglePublisherandSi
ROS学习笔记4源码-话题发布者案例程序.zip
03-17
ROS（Robot Operating System）是机器人领域广泛使用的一个开源操作系统，它提供了一整套工具和库，使得机器人软件...实践中遇到的问题和解决过程，都将加深对ROS通信模型的理解，为后续的机器人项目打下坚实的基础。
ROS2学习笔记三：话题Topic
嵌入式大师之路
01-11 1912
ROS2中的一个重要概念是话题（Topic）。话题是一种通过发布者和订阅者之间进行异步通信的机制。发布者（Publisher）将消息发布到特定的话题上，而订阅者（Subscriber）则可以选择订阅感兴趣的话题，并接收发布者发送的消息。话题可以用来传递各种类型的消息，例如传感器数据、机器人状态、控制指令等。每个话题有一个唯一的名称，并且可以有多个发布者和订阅者。ROS2提供了一套API来操作话题。开发者可以使用语言（如C++和Python）来编写发布者和订阅者节点，并在运行时将它们连接到ROS2系统中。
ROS2-DL 基于Ubuntu20.04—通过ros2发布自己的deep learning检测结果(三)(根据检测结果自定义msg)
最新发布
Functioe的博客
05-10 683
在创建自定义msg之前，确定yolov4dm检测输出内容需要包括车位框坐标信息、障碍物框坐标信息 并都各自整体以列表传递。修改YOLOV4DM/src/yolov4dm/yolov4dm/yolo.py车位框坐标信息：障碍物框坐标信息：返回修改YOLOV4DM/src/yolov4dm/yolov4dm/yolo.py。
【ROS2入门】理解 ROS 2 Topics 话题
cau_weiyuhu的博客
01-14 3081
介绍 ROS2 eloquent版本在EHub_tx1_tx2_E100载板，Jeston TX1 核心模块，JetPack_4.6.3刷机后， ubuntu18.04 环境下介绍和学习Topic，这个主要概念，并使用rqt_graph和命令行工具 详细 了解 ROS 2 Topic 概念。
[ROS2] --- topic
M2嵌入式
12-08 792
Topic通信模型是一种发布订阅模型，ROS2使用了基于DDS的发布/订阅模型，数据传输过程如下图：话题数据传输的特性是从一个节点到另外一个节点，。
ROS 2主题-topics-
zhangrelay的专栏
12-11 3308
前序：ROS 2节点-nodes- 本节详细介绍主题topic。 1. 如何理解主题topic： ROS 2将复杂的系统分解为许多模块化的节点。主题是ROS图（ROS graph）的重要元素，功能为节点交换消息的总线。节点可以将数据发布到任意数量的主题，与此同时，可以实现对任意数量主题的订阅。主题是节点间数据交互的重要方式，同样也适用于系统各种不同模块之间的交互。 2. 主题topic...
ROS入门级教程学习笔记.pdf
06-22
这一篇学习笔记是根据ROS官方教程来写的，跟上一篇相比不注重指令记录，而是注重编译文件的修改和节点源文件的编写。笔记记录了topic和service两种通信方式的具体实现方法。
ROS2官网教程学习笔记理解ROS2服务篇
01-20
在ROS2中，服务和话题类似，都是节点间通信的方式，但服务的特点在于它们是请求-响应式的，即一个节点（客户端）发起请求，另一个节点（服务器）接收到请求后处理并返回响应。 以下是学习ROS2服务的具体步骤： 1. ...
ROS2一些学习笔记仅个人记录
02-25
话题是 ROS2 中的一种通信机制。可以使用以下命令来查看话题列表： ``` ros2 topic list ``` 查看某个话题的信息： ``` ros2 topic echo ``` 发布话题消息： ``` ros2 topic pub <topic_name> <msg_type> '...
古月居ROS入门21讲学习笔记（核心概念6-8课）
01-06
ROS=通信机制+开发工具+应用功能+生态系统 通信机制 松耦合分布式通信 开发工具 命令行&编译器 TF坐标变换 QT工具箱 Rviz Gazebo 应用功能 SLAM Navigation Movelt！ 关注接口，输入输出就行，其次再关注算法就行。...
ROS2学习——（ROS2主题topic）
Siva5的博客
06-05 5538
主题（topic）是各节点之间的信息交流媒介，可以实现一对一，一对多，多对一，多对多的信息交流，如图所示（1）打开rqt_graph通过命令：rqt_graph打开，也可以通过rqt打开后，选择Plugins>Introspection>Node Graph,打开后的界面如图（信息显示不全的可以刷新一下）；上图中，/turtlesim和/teleop_turtle是节点（node）将鼠标移至某个框后将会高亮显示，如图，红色为鼠标所处位置，蓝色是输入，绿色输出。节点/teleop_turtle和t/turtl
ROS2——topic话题（八）
戚晨夕的博客
07-03 1546
节点实现了机器人各种各样的功能，但这些功能并不是独立的，之间会有千丝万缕的联系，其中最重要的一种联系方式就是话题，它是节点间传递数据的桥梁。 以两个机器人节点为例。A节点的功能是驱动相机这个硬件设备，获取得到相机拍摄的图像信息，B节点的功能是视频监控，将相机拍摄到的图像实时显示给用户查看。此时从节点A到节点B传递图像数据的方式，在ROS中，我们就称之为话题，它作为一个桥梁，实现了节点之间某一个方向上的数据传输。从话题本身的实现角度来看，使用了基于DDS的发布/订阅模型，什么叫发布和订阅呢？ 话题数据传输的
ROS2—理解话题（Topic）
hx1113的博客
12-06 3302
大道至简，ROS2将复杂的机器人系统拆解成许多模块节点，而这些节点之间则是通过一个至关重要的通道完成数据交换的，这个通道就是“话题”。 一个节点可以通过多个话题向外发布数据，也可以同时订阅多个其他节点发布的话题，相当于话题是一个多对多的订阅/发布模型。 可见，话题是节点之间实现数据传输的重要途径，也是机器人各个子系统之间交换数据的重要方式。 1.启动小海龟仿真器 还是先来启动小海龟仿真器吧，相信你已经很熟练了： ros2 run turtlesim turtlesim_node ..
ROS2 学习笔记4：了解ROS2 话题Topic
weixin_43180456的博客
01-18 1337
节点通过话题发布消息，其他节点可以通过订阅（话题）来获取消息．在本课程中，通过rqt_graph以及命令行工具，你学习了多个节点通过话题连接起来．现在，你应该对于ros２系统数据传输有了很好认识。
ROS2学习笔记４--认识ros2话题topic
qq_45701501的博客
07-06 4389
概要：这篇主要认识ros2话题topic 环境：ubuntu20.04,ros2-foxy,vscode 2.1.4认识ros2话题topic（原文：https://docs.ros.org/en/foxy/Tutorials/Topics/Understanding-ROS2-Topics.html） >>教程>>认识ros2话题topic 你正阅读的是ros2较老版本(Foxy)，但仍然支持的说明文档．想查看最新版本的信息，请看galactic版本链接（ https://docs
【ROS2学习笔记】: TOPIC 篇
lxxwkan的博客
07-11 330
teleop_turtle节点正在向/turtle 1/cmd_vel主题发布数据（您输入的移动乌龟的按键），而/turtlesim节点订阅了该主题以接收数据。您应该可以看到上面的节点和主题，以及图形外围的两个操作（我们暂时忽略它们）。如果您将鼠标悬停在中心的主题上，您将看到颜色突出显示，如上图所示。rqt_graph的突出显示特性在检查具有许多节点和以许多不同方式连接的主题的更复杂的系统时非常有帮助。后看到的主题类型让我们知道每个主题上使用的消息类型。它们可以是一对多、多对一或多对多。
ROS2学习笔记，案例实现记录——11.话题topic
鱼_丸 的 博客
07-22 459
需要继续下面服务的学习，需要先定义该服务所使用的消息格式。用request和response来定义请求和响应，以实现我们的服务逻辑。这里需要创建消息，我在功能包下建立了msg文件夹，在文件夹中创建了一个名为的服务文件，并在其中定义了请求和响应的消息格式。此文章中的案例：①每隔一秒发布一个随机数到指定的主题上；②实现一个服务客户端节点，用于向服务端发送服务请求，比较输入的两个整数的大小，并获取最大值和最小值。
ROS2教程－理解ROS2 topics
自动驾驶小白
06-22 4635
背景 ROS2将复杂的系统分解为很多模块节点．话题(Topics)是ROS图中的重要元素，是节点交换信息的途径．一个节点可以同步发布任意数量的话题，也可以同步接收任意数量的消息．话题（topics）是数据在节点以及系统不同部分之间交换的最重要的方式． ROS 2 breaks complex systems down into many modular nodes. Topics are a vital element of the ROS graph that act as a bus for nod
ros2 foxy话题通信
09-15
ROS 2的Foxy版本是ROS（Robot Operating System）的一个稳定版本，其中包含了一些新的特性和改进。在ROS 2 Foxy中，话题通信仍然是一个重要的概念。 在ROS 2中，话题是一种用于传递消息的机制。通过发布者（Publisher）和订阅者（Subscriber）之间的话题通信，节点可以共享信息。话题的消息类型在编译时确定，并且使用ROS 2的接口定义语言（IDL）来描述。 要进行话题通信，首先需要定义消息类型。可以使用ROS 2提供的标准消息类型，也可以自定义消息类型。接下来，在发布者节点中创建一个发布者对象，并指定要发布的话题名称和消息类型。然后，在订阅者节点中创建一个订阅者对象，并指定要订阅的话题名称和消息类型。 发布者节点将消息发布到话题上，而订阅者节点将从话题上接收到发布者发送的消息。这样，节点之间就可以实现信息的传递和共享。 以下是一个简单的示例代码，演示了如何在ROS 2 Foxy中进行话题通信： 发布者节点代码： ```python import rclpy from std_msgs.msg import String def main(args=None): rclpy.init(args=args) node = rclpy.create_node('publisher') publisher = node.create_publisher(String, 'topic_name') msg = String() msg.data = 'Hello, ROS 2!' while rclpy.ok(): publisher.publish(msg) rclpy.spin_once(node) node.destroy_node() rclpy.shutdown() if __name__ == '__main__': main() ``` 订阅者节点代码： ```python import rclpy from std_msgs.msg import String def callback(msg): print('Received message:', msg.data) def main(args=None): rclpy.init(args=args) node = rclpy.create_node('subscriber') subscriber = node.create_subscription(String, 'topic_name', callback) rclpy.spin(node) node.destroy_node() rclpy.shutdown() if __name__ == '__main__': main() ``` 在上面的示例中，发布者节点创建了一个发布者对象，并使用`node.create_publisher`方法指定了要发布的话题名称。每次循环中，它都会发布一个包含字符串消息的消息对象。 订阅者节点创建了一个订阅者对象，并使用`node.create_subscription`方法指定了要订阅的话题名称和回调函数。每当收到来自发布者的消息时，回调函数将被调用，并打印出接收到的消息内容。 这只是一个简单的示例，实际中可能会涉及更复杂的消息类型和逻辑。但是，通过这个基本的框架，你可以开始在ROS 2 Foxy中进行话题通信。

“相关推荐”对你有帮助么？

  • 非常没帮助
  • 没帮助
  • 一般
  • 有帮助
  • 非常有帮助
提交
评论 1
添加红包

请填写红包祝福语或标题

个

红包个数最小为10个

元

红包金额最低5元

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

打赏作者

木心

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

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

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

打赏作者

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

抵扣说明：

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

余额充值