第3章 ROS工具与调试

3、ROS工具与调试：rqt_graph可视化、rosbag数据录制与回放、tf坐标变换、launch文件编写

做机器人开发，最怕什么？

怕代码跑起来像个黑盒子，不知道里面发生了什么。怕机器人撞墙了，却找不到原因。怕调试时重复跑实验，浪费大把时间。

这些坑，我都踩过。今天这章，我就把ROS里最实用的四个调试工具讲透。说白了，它们就是你的「机器人CT机」和「时光机」。

3.1 rqt_graph：看清你的节点通信

我第一次用rqt_graph，是在一个多传感器融合的项目里。当时机器人定位总跳变，我怀疑是话题连接出了问题。运行rqt_graph一看，好家伙，有个节点连错了话题，数据根本没传过去。

这个工具，能把你代码里的节点、话题、服务连接关系，画成一张清晰的图。

启动方式：

rosrun rqt_graph rqt_graph
# 或者
rqt_graph

你会看到什么？

椭圆：代表ROS节点（Node）
矩形：代表话题（Topic）
箭头：代表数据流向

我个人习惯，每次启动新系统后，第一件事就是打开rqt_graph。看一眼图，心里就有底了。如果发现某个节点孤零零的，没有连线，那八成是代码里订阅或发布的名字写错了。

小技巧：

勾选左上角的「Nodes only」和「Hide debug」，图会清爽很多。你还可以点击某个节点，高亮显示它的所有连接。

3.2 rosbag：机器人的「黑匣子」

rosbag是我最常用的工具，没有之一。

为什么？因为真实机器人跑起来，你不可能每次都复现同样的场景。但有了rosbag，你可以把一次实验的所有数据录下来，回家慢慢分析。

3.2.1 录制数据

# 录制所有话题
rosbag record -a

# 录制指定话题
rosbag record /odom /scan /cmd_vel

# 录制并指定包名
rosbag record -O my_experiment.bag /odom /scan

我曾经在调试导航算法时，机器人总是在同一个墙角卡住。我录了10分钟的bag数据，回家反复回放，终于发现是激光雷达在那个角度有盲区。没有rosbag，这种问题根本没法定位。

3.2.2 回放数据

# 基本回放
rosbag play my_experiment.bag

# 循环回放
rosbag play -l my_experiment.bag

# 以0.5倍速回放
rosbag play -r 0.5 my_experiment.bag

注意：

回放时，默认会使用bag文件里的时间戳。如果你想用当前系统时间，加上--clock参数。另外，回放时记得把真实机器人断开，不然它会真的动起来——别问我怎么知道的。

3.2.3 查看bag信息

rosbag info my_experiment.bag

这条命令会告诉你：录制时长、话题列表、消息数量、大小等。我每次录完数据，都会先跑一下rosbag info，确认数据完整。

3.3 tf坐标变换：机器人的「空间感」

tf是ROS里最核心的概念之一。说白了，它解决的就是一个问题：机器人身上各个部件之间的位置关系。

比如，激光雷达装在机器人前方0.3米处，摄像头装在顶部0.5米处。当激光雷达检测到前方1米有障碍物，这个障碍物在机器人坐标系下的位置是多少？在摄像头坐标系下呢？

这些计算，tf帮你自动完成。

3.3.1 发布静态变换

# 使用static_transform_publisher
rosrun tf2_ros static_transform_publisher 0.3 0 0.5 0 0 0 base_link laser_frame

这行命令的意思是：laser_frame相对于base_link，在x方向偏移0.3米，z方向偏移0.5米，没有旋转。

常用工具：

tf_echo：查看两个坐标系之间的变换关系
view_frames：生成tf树的可视化PDF
rviz：在可视化界面中查看tf

3.3.2 在代码中使用tf

# C++示例
tf2_ros::Buffer tfBuffer;
tf2_ros::TransformListener tfListener(tfBuffer);

geometry_msgs::TransformStamped transformStamped;
try {
  transformStamped = tfBuffer.lookupTransform("base_link", "laser_frame", ros::Time(0));
} catch (tf2::TransformException &ex) {
  ROS_WARN("%s", ex.what());
}

嗯，这里要注意：lookupTransform的第三个参数，用ros::Time(0)表示获取最新可用的变换。如果你指定具体时间戳，可能会因为数据延迟而抛出异常。

3.4 launch文件：一键启动所有节点

你想想看，一个完整的机器人系统，可能要启动十几个节点：驱动、传感器、导航、可视化...如果每次都要手动开终端，那得多崩溃？

launch文件就是干这个的。它让你用一个命令，启动所有需要的节点。

3.4.1 基本结构

<?xml version="1.0"?>
<launch>
  <!-- 启动机器人驱动 -->
  <node name="robot_driver" pkg="my_robot_bringup" type="robot_driver_node" output="screen"/>

  <!-- 启动激光雷达 -->
  <node name="lidar" pkg="rplidar_ros" type="rplidarNode">
    <param name="serial_port" value="/dev/ttyUSB0"/>
  </node>

  <!-- 启动rviz -->
  <node name="rviz" pkg="rviz" type="rviz" args="-d $(find my_robot_bringup)/config/nav.rviz"/>
</launch>

3.4.2 常用标签

标签	作用	示例
`<node>`	启动一个节点	`<node name="..." pkg="..." type="..." />`
`<param>`	设置参数	`<param name="rate" value="10" />`
`<rosparam>`	从文件加载参数	`<rosparam file="config.yaml" />`
`<include>`	包含其他launch文件	`<include file="$(find pkg)/launch/other.launch" />`
`<arg>`	定义参数变量	`<arg name="use_sim" default="true" />`

我的习惯：

我会把launch文件分成三层：

硬件层：启动传感器、驱动
算法层：启动导航、定位
可视化层：启动rviz、rqt

这样调试时，可以只启动需要的部分，不用每次都跑全套。

3.4.3 使用arg实现灵活配置

<launch>
  <arg name="use_sim_time" default="false"/>

  <param name="use_sim_time" value="$(arg use_sim_time)"/>

  <group if="$(arg use_sim_time)">
    <node name="sim_time_publisher" pkg="my_pkg" type="publish_sim_time.py"/>
  </group>
</launch>

启动时，你可以这样传参：

roslaunch my_pkg system.launch use_sim_time:=true

这样，同一个launch文件，既能用于真实机器人，也能用于仿真环境。

3.5 实战：把这些工具串起来

我建议你养成一个习惯：每次调试时，按这个流程走一遍：

启动系统：用launch文件一键启动
检查通信：打开rqt_graph，确认节点连接正确
录制数据：用rosbag记录关键话题
验证坐标：用tf_echo检查坐标系变换
回放分析：回家后，用rosbag play + rviz复现问题

这套流程，我在多个项目里验证过，能解决90%的调试问题。剩下的10%，嗯，那就要靠经验和一点点运气了。

一句话总结：

rqt_graph让你「看见」通信，rosbag让你「留住」数据，tf让你「算清」坐标，launch让你「一键」启动。这四个工具，是ROS调试的四大支柱。