ROS2新手必看：5分钟搞定Python功能包创建与消息订阅发布

ROS2 Python功能包开发实战：从零实现消息订阅与发布

第一次接触ROS2时，最让人头疼的就是如何快速搭建一个可运行的功能包。记得去年我在机器人项目中，花了整整两天时间才搞明白Python功能包的创建流程。今天，我将把这些经验浓缩成最实用的步骤，让你在5分钟内跑通第一个ROS2 Python程序。

1. 环境准备与基础概念

在开始之前，确保你已经安装了ROS2（推荐Humble或Foxy版本）。打开终端，运行以下命令验证安装：

ros2 --version

ROS2功能包是代码组织的核心单元，Python功能包使用ament_python构建系统。与C++包不同，Python包不需要编译（但需要安装），这使得开发迭代更加快速。

关键术语理解：

• 功能包(Package)：ROS2中的基本代码组织单元
• 节点(Node)：功能包中的可执行程序
• Topic：节点间通信的通道
• 消息(Message)：在Topic上传输的数据结构

2. 创建Python功能包

在ROS2工作空间的src目录下，执行以下命令创建Python功能包：

ros2 pkg create --build-type ament_python demo_pkg --dependencies rclpy

这个命令创建了一个名为demo_pkg的Python包，并自动添加了rclpy依赖（ROS2的Python客户端库）。

创建完成后，目录结构应该如下：

demo_pkg/ ├── demo_pkg │ └── __init__.py ├── package.xml ├── resource │ └── demo_pkg ├── setup.cfg └── setup.py

关键文件说明：

3. 编写第一个ROS2节点

在demo_pkg/demo_pkg目录下创建demo_node.py文件，这是我们的第一个节点：

#!/usr/bin/env python3 import rclpy from rclpy.node import Node class DemoNode(Node): def __init__(self): super().__init__('demo_node') self.get_logger().info('Hello ROS2!') def main(args=None): rclpy.init(args=args) node = DemoNode() rclpy.spin(node) node.destroy_node() rclpy.shutdown() if __name__ == '__main__': main()

要让这个节点可执行，需要在setup.py中注册：

entry_points={ 'console_scripts': [ 'demo_node = demo_pkg.demo_node:main', ], },

4. 实现消息发布与订阅

4.1 创建发布者节点

扩展我们的DemoNode，添加消息发布功能：

from std_msgs.msg import String class PublisherNode(Node): def __init__(self): super().__init__('publisher_node') self.publisher = self.create_publisher(String, 'demo_topic', 10) self.timer = self.create_timer(1.0, self.timer_callback) self.counter = 0 def timer_callback(self): msg = String() msg.data = f'Hello World: {self.counter}' self.publisher.publish(msg) self.get_logger().info(f'Publishing: "{msg.data}"') self.counter += 1

4.2 创建订阅者节点

在同一包中创建订阅者节点：

class SubscriberNode(Node): def __init__(self): super().__init__('subscriber_node') self.subscription = self.create_subscription( String, 'demo_topic', self.listener_callback, 10) def listener_callback(self, msg): self.get_logger().info(f'I heard: "{msg.data}"')

5. 构建与运行

在包目录下执行以下命令安装依赖并构建：

colcon build --packages-select demo_pkg source install/setup.bash

然后分别运行发布者和订阅者：

# 新终端 ros2 run demo_pkg demo_node publisher # 另一个终端 ros2 run demo_pkg demo_node subscriber

6. 常见问题排查

问题1：找不到自定义消息

• 解决方案：在package.xml中添加消息依赖：

<exec_depend>std_msgs</exec_depend>

问题2：修改代码后变化未生效

• 尝试删除build和install目录中的包文件夹，然后重新构建

问题3：节点无法通信

• 检查话题名称是否一致
• 使用ros2 topic list确认话题是否存在

7. 进阶技巧

1. 使用launch文件：创建launch/demo.launch.py来同时启动多个节点
2. 自定义消息：在包中创建msg/目录定义自己的消息类型
3. 参数配置：使用declare_parameter实现运行时参数配置

# 在节点初始化中添加 self.declare_parameter('publish_rate', 1.0) rate = self.get_parameter('publish_rate').value self.timer = self.create_timer(rate, self.timer_callback)

在实际项目中，我发现将发布和订阅逻辑分离到不同节点是最佳实践。这样不仅便于调试，还能更好地模拟真实机器人系统中的分布式架构。