机器人 / 系统课时
用 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 |
本例不使用的运动分量 |

示例使用 /demo/cmd_vel,避免误发到实际底盘通常监听的 /cmd_vel。同一话题上的发布者和订阅者必须使用兼容的消息类型及 QoS;这里两端都使用队列深度 10 的默认 QoS。
编写定时发布节点
环境采用 Ubuntu 24.04、ROS 2 Jazzy,且已安装 rclpy 和 geometry_msgs。在同一普通目录中保存文件 velocity_publisher.py;不需要先创建 ROS 功能包,也可以通过 python3 直接运行。
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 环境并启动:
source /opt/ros/jazzy/setup.bash
export ROS_DOMAIN_ID=42
python3 velocity_publisher.py预期输出(<TIME> 是运行时变化的时间戳):
[INFO] [<TIME>] [velocity_publisher]: publishing /demo/cmd_vel at 10 Hz该日志只表示发布节点已启动;是否被订阅者接收,要在下一步验证。create_timer(0.1, ...) 会持续触发回调,直到按 Ctrl+C 停止。
编写速度订阅节点
在同一目录保存 velocity_subscriber.py。订阅回调只读取并记录消息,不连接电机驱动,便于单独确认数据通路。rclpy.spin() 必须持续运行,否则订阅回调不会被正常调度。
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 一致:
source /opt/ros/jazzy/setup.bash
export ROS_DOMAIN_ID=42
python3 velocity_subscriber.py预期输出会以约 10 Hz 重复(时间戳每条不同):
[INFO] [<TIME>] [velocity_subscriber]: linear.x=0.20 m/s, angular.z=0.50 rad/s这验证了订阅回调能读到发布端设置的两个数值。回调频率受调度和系统负载影响,不要求每秒恰好出现十行。
用命令行核对消息
让终端 A、B 保持运行,在终端 C 加载相同环境,先检查话题端点数量:
source /opt/ros/jazzy/setup.bash
export ROS_DOMAIN_ID=42
ros2 topic info /demo/cmd_vel仅运行这两个示例节点时,预期输出:
Type: geometry_msgs/msg/Twist
Publisher count: 1
Subscription count: 1随后在终端 C 读取一条速度消息:
ros2 topic echo /demo/cmd_vel --once预期输出:
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;如果发现数量不对,应先解决进程和发现问题,而不是修改速度参数。
也不要把“一次发布无响应”直接判成程序错误:发布端与订阅端需要发现时间,且普通话题不保存给后来加入的订阅者的历史命令。保持本例的连续发布,再观察订阅回调,是更可靠的基础验证方式。