4、ROS2工具与调试：命令行工具、bag包、tf2与Launch文件

各位同学，咱们今天聊点实在的。ROS2开发，说白了就是跟各种节点、话题、服务打交道。你写代码写得再漂亮，不会调试，那等于白搭。我个人习惯，先把命令行工具玩溜了，再谈别的。

4.1 命令行工具：你的第二双手

ROS2的命令行工具，我称之为「救命三件套」：ros2 node、ros2 topic、ros2 service 和 ros2 action。你想想看，一个系统跑起来，你总得知道谁在说话、说了什么、谁在干活吧？

4.1.1 ros2 node：查户口

先看节点。节点就是ROS2里的「人」。用 ros2 node list 能列出所有活着的节点。我曾经在一个大项目里，启动文件写错了，节点死活起不来，就是靠这条命令一个个排查的。

# 列出所有节点
ros2 node list

# 查看某个节点的详细信息
ros2 node info /your_node_name

嗯，这里要注意：节点名别搞混了。ROS2里节点名是唯一的，重名了会报错。

4.1.2 ros2 topic：听墙根

话题是节点之间通信的「频道」。你想知道传感器发了什么数据？用 ros2 topic echo 直接监听。

# 列出所有话题
ros2 topic list

# 监听某个话题的数据流
ros2 topic echo /your_topic

# 查看话题的发布频率
ros2 topic hz /your_topic

我记得有一次，机器人走起来一卡一卡的。我第一反应就是查控制指令的发布频率。结果发现频率只有10Hz，正常应该是50Hz。原来是CPU负载太高，节点被调度器降频了。你看，一条命令就定位了问题。

4.1.3 ros2 service：打电话

服务是「一问一答」的模式。适合那些需要即时响应的操作，比如「打开灯光」、「获取当前位姿」。

# 列出所有服务
ros2 service list

# 调用一个服务
ros2 service call /your_service your_package/srv/YourService "data: value"

避坑指南：我曾经在调用服务时，参数类型写错了，结果服务端一直报错。后来才发现，ROS2的服务参数是强类型的，字符串和整数不能混用。

4.1.4 ros2 action：派任务

动作是「派任务」的模式。适合那些需要长时间执行的任务，比如「导航到A点」、「抓取物体」。动作有反馈，你可以随时取消。

# 列出所有动作
ros2 action list

# 发送一个动作目标
ros2 action send_goal /your_action your_package/action/YourAction "goal: value"

4.2 Bag包录制与回放：时间机器

Bag包，说白了就是ROS2的「黑匣子」。你把所有话题数据录下来，回头慢慢分析。我在做机器人现场调试时，经常把整个任务过程录下来，回办公室再复盘。

4.2.1 录制Bag包

# 录制所有话题
ros2 bag record -a

# 录制指定话题
ros2 bag record /topic1 /topic2 /topic3

嗯，这里有个坑：-a 参数会录制所有话题，数据量巨大。我建议只录你关心的几个话题，不然硬盘分分钟爆掉。

4.2.2 回放Bag包

# 回放bag包
ros2 bag play your_bag_file

# 指定回放速度（0.5倍速）
ros2 bag play your_bag_file --rate 0.5

为什么要回放？你想想看，现场环境复杂，你没法复现。但有了bag包，你可以把数据喂给算法，反复调试，直到满意为止。

4.3 tf2坐标变换：机器人的空间感

tf2是ROS2里处理坐标变换的库。说白了，就是让机器人知道「我的手在哪儿」、「我的头在哪儿」。没有tf2，机器人就是个瞎子。

4.3.1 查看tf树

# 查看tf树
ros2 run tf2_tools view_frames

# 监听tf变换
ros2 run tf2_ros tf2_echo /base_link /camera_link

我记得第一次做机械臂项目时，tf树画出来有十几个节点，看得我头皮发麻。后来发现，只要理清父子关系，其实没那么复杂。

4.3.2 常见问题

• tf断链：某个坐标变换没发布，导致下游节点报错。用 view_frames 一眼就能看出来。
• 时间戳问题：tf变换有缓存时间，如果时间戳对不上，会报「Lookup would require extrapolation」。我建议用 tf2_echo 先看看时间戳是否正常。

4.4 Launch文件编写与参数传递

Launch文件，就是ROS2的「启动脚本」。你总不能每次启动系统都手动敲十几条命令吧？Launch文件帮你一键搞定。

4.4.1 基本结构

from launch import LaunchDescription
from launch_ros.actions import Node

def generate_launch_description():
    return LaunchDescription([
        Node(
            package='your_package',
            executable='your_node',
            name='your_node_name',
            parameters=[{'param1': 'value1', 'param2': 42}]
        )
    ])

你看，一个Launch文件，就是一个Python脚本。你可以在里面写逻辑，比如条件判断、循环启动。

4.4.2 参数传递

参数传递，说白了就是给节点「喂配置」。我习惯把参数写在YAML文件里，Launch文件去加载它。

# params.yaml
your_node_name:
  ros__parameters:
    param1: "value1"
    param2: 42

# launch文件加载参数
Node(
    package='your_package',
    executable='your_node',
    name='your_node_name',
    parameters=['params.yaml']
)

为什么要用YAML？因为好维护。你改参数不用改代码，改个YAML文件就行。我曾经在一个项目里，把参数写死在代码里，结果每次调参都要重新编译，烦死了。

4.4.3 高级技巧

• 条件启动：根据参数决定是否启动某个节点。
• 命名空间：给节点加上命名空间，避免重名。
• 包含其他Launch文件：模块化设计，一个Launch文件可以包含另一个。

好了，这一章的内容就这些。命令行工具、bag包、tf2、Launch文件，这四个工具是ROS2调试的基石。你把这些玩熟了，后面学运动规划就轻松多了。下一章，咱们聊聊「执行器控制」的核心概念。