机器人 / 系统课时

用 Topic 传递速度命令

用 Topic 传递速度命令

速度规划节点需要持续告诉底盘“向前多快、转弯多快”,但不必等待每条命令的处理结果。本课在 ROS 2 Jazzy 中用 Python 编写 Twist 发布者与订阅者,再验证话题类型、收发数量和实际速度值。

学习目标

  • 识别 Twist 的线速度、角速度字段及单位。
  • 用 rclpy 定时发布速度命令,并在订阅回调中读取。
  • 通过 ROS 2 命令行确认两个节点完成异步通信。

速度消息如何传递

ROS 2 Topic 采用发布订阅通信。发布节点每隔 0.1 秒发送一条 geometry_msgs/msg/Twist,订阅节点通过 DDS 发现并匹配端点;新消息到达后,由 rclpy.spin() 调度回调。双方不用互相调用函数,也不等待逐条响应。

Twist 有两个三维向量。下表是差速机器人平面运动的一组测试命令,未赋值的分量默认是零:

字段 示例值 含义
linear.x 0.20 向前速度,单位 m/s
angular.z 0.50 绕竖直轴的角速度,单位 rad/s,正值通常表示左转
linear.y、linear.z、angular.x、angular.y 0.0 本例不使用的运动分量

Twist 速度命令在发布者与订阅者之间异步流动

示例使用 /demo/cmd_vel,避免误发到实际底盘通常监听的 /cmd_vel。同一话题上的发布者和订阅者必须使用兼容的消息类型及 QoS;这里两端都使用队列深度 10 的默认 QoS。

编写定时发布节点

环境采用 Ubuntu 24.04、ROS 2 Jazzy,且已安装 rclpy 和 geometry_msgs。在同一普通目录中保存文件 velocity_publisher.py;不需要先创建 ROS 功能包,也可以通过 python3 直接运行。

python
import rclpy
from geometry_msgs.msg import Twist
from rclpy.executors import ExternalShutdownException
from rclpy.node import Node

class VelocityPublisher(Node):
    def __init__(self):
        super().__init__('velocity_publisher')
        self.publisher = self.create_publisher(Twist, '/demo/cmd_vel', 10)
        # 0.1 秒发送一次,让发现完成后也有后续消息可接收
        self.timer = self.create_timer(0.1, self.send_velocity)
        self.get_logger().info('publishing /demo/cmd_vel at 10 Hz')

    def send_velocity(self):
        msg = Twist()
        msg.linear.x = 0.2
        msg.angular.z = 0.5
        # 其余 Twist 分量保持默认的 0
        self.publisher.publish(msg)

def main(args=None):
    rclpy.init(args=args)
    node = VelocityPublisher()
    try:
        rclpy.spin(node)
    except (KeyboardInterrupt, ExternalShutdownException):
        pass
    finally:
        node.destroy_node()
        if rclpy.ok():
            rclpy.shutdown()

if __name__ == '__main__':
    main()

在终端 A 切换到脚本目录,加载 ROS 环境并启动:

bash
source /opt/ros/jazzy/setup.bash
export ROS_DOMAIN_ID=42
python3 velocity_publisher.py

预期输出(<TIME> 是运行时变化的时间戳):

text
[INFO] [<TIME>] [velocity_publisher]: publishing /demo/cmd_vel at 10 Hz

该日志只表示发布节点已启动;是否被订阅者接收,要在下一步验证。create_timer(0.1, ...) 会持续触发回调,直到按 Ctrl+C 停止。

编写速度订阅节点

在同一目录保存 velocity_subscriber.py。订阅回调只读取并记录消息,不连接电机驱动,便于单独确认数据通路。rclpy.spin() 必须持续运行,否则订阅回调不会被正常调度。

python
import rclpy
from geometry_msgs.msg import Twist
from rclpy.executors import ExternalShutdownException
from rclpy.node import Node

class VelocitySubscriber(Node):
    def __init__(self):
        super().__init__('velocity_subscriber')
        # 话题名、消息类型与发布端一致;深度均为 10
        self.subscription = self.create_subscription(
            Twist, '/demo/cmd_vel', self.on_velocity, 10
        )

    def on_velocity(self, msg):
        self.get_logger().info(
            f'linear.x={msg.linear.x:.2f} m/s, '
            f'angular.z={msg.angular.z:.2f} rad/s'
        )

def main(args=None):
    rclpy.init(args=args)
    node = VelocitySubscriber()
    try:
        rclpy.spin(node)
    except (KeyboardInterrupt, ExternalShutdownException):
        pass
    finally:
        node.destroy_node()
        if rclpy.ok():
            rclpy.shutdown()

if __name__ == '__main__':
    main()

在终端 B 启动,注意域 ID 必须和终端 A 一致:

bash
source /opt/ros/jazzy/setup.bash
export ROS_DOMAIN_ID=42
python3 velocity_subscriber.py

预期输出会以约 10 Hz 重复(时间戳每条不同):

text
[INFO] [<TIME>] [velocity_subscriber]: linear.x=0.20 m/s, angular.z=0.50 rad/s

这验证了订阅回调能读到发布端设置的两个数值。回调频率受调度和系统负载影响,不要求每秒恰好出现十行。

用命令行核对消息

让终端 A、B 保持运行,在终端 C 加载相同环境,先检查话题端点数量:

bash
source /opt/ros/jazzy/setup.bash
export ROS_DOMAIN_ID=42
ros2 topic info /demo/cmd_vel

仅运行这两个示例节点时,预期输出:

text
Type: geometry_msgs/msg/Twist
Publisher count: 1
Subscription count: 1

随后在终端 C 读取一条速度消息:

bash
ros2 topic echo /demo/cmd_vel --once

预期输出:

text
linear:
  x: 0.2
  y: 0.0
  z: 0.0
angular:
  x: 0.0
  y: 0.0
  z: 0.5
---

读数应与 Python 代码一致。还可运行 ros2 topic hz /demo/cmd_vel 观察接收频率,通常接近 10 Hz;按 Ctrl+C 退出持续统计。

收不到消息时检查什么

如果订阅端没有日志,先检查两端是否都执行了环境加载并设置 ROS_DOMAIN_ID=42,再确认话题名称都为 /demo/cmd_vel、类型都是 geometry_msgs/msg/Twist。运行 ros2 topic info /demo/cmd_vel -v 可查看端点及 QoS;如果发现数量不对,应先解决进程和发现问题,而不是修改速度参数。

也不要把“一次发布无响应”直接判成程序错误:发布端与订阅端需要发现时间,且普通话题不保存给后来加入的订阅者的历史命令。保持本例的连续发布,再观察订阅回调,是更可靠的基础验证方式。

按自己的节奏,确认真正理解。

目录与阅读设置

阅读设置

17

记录一个想法

用 Topic 传递速度命令

0 / 10000 · 笔记保存到账号。未提交的修改会在关闭、离开或刷新后丢失。

登录哪都通