第4章：ROS2工具链与调试：命令行工具、日志系统、TF坐标变换基础

说实话，很多初学者一上来就急着写代码、搭仿真，结果出了问题两眼一抹黑。我见过太多人卡在「不知道哪里错了」这一步。其实ROS2自带的那套工具链，用好了能省你一半的调试时间。今天咱们就聊聊这些趁手的家伙事儿。

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

ROS2的命令行工具，说白了就是你和系统对话的接口。我平时调试时，80%的时间都在敲这些命令。

4.1.1 ros2 topic：看数据流动

你想想看，自动驾驶系统里，传感器数据、控制指令都在topic上跑。想知道激光雷达发了什么？直接看：

# 列出所有话题
ros2 topic list

# 看某个话题的实时数据
ros2 topic echo /scan

# 看话题的详细信息（类型、QoS等）
ros2 topic info /scan

# 看发布频率
ros2 topic hz /scan

我个人习惯，调试时先开三个终端：一个跑节点，一个看topic echo，一个看topic hz。这样数据对不对、频率稳不稳，一目了然。

4.1.2 ros2 service：一问一答的通信

Topic是持续广播，Service是请求-响应。比如你要让车辆切换模式：

# 列出所有服务
ros2 service list

# 查看服务类型
ros2 service type /service_name

# 调用服务（带参数）
ros2 service call /set_vehicle_mode std_srvs/srv/SetBool "{data: true}"

我曾经在实车调试时，发现车辆死活不响应模式切换。后来用 ros2 service list 一查，发现服务根本没注册。嗯，这种低级错误，工具一查就现原形。

4.1.3 ros2 bag：数据回放利器

做自动驾驶，数据采集和回放是家常便饭。ros2 bag就是你的「行车记录仪」：

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

# 录制指定话题
ros2 bag record /scan /cmd_vel

# 查看bag信息
ros2 bag info bag_name

# 回放数据
ros2 bag play bag_name

4.2 日志系统：别让错误藏起来

ROS2的日志系统比ROS1强太多了。它分五个级别：DEBUG、INFO、WARN、ERROR、FATAL。我建议你养成好习惯，该打日志的地方别偷懒。

4.2.1 日志的基本用法

# 在代码里
RCLCPP_INFO(rclcpp::get_logger("my_node"), "车辆速度: %.2f m/s", speed);
RCLCPP_WARN(rclcpp::get_logger("my_node"), "GPS信号弱");
RCLCPP_ERROR(rclcpp::get_logger("my_node"), "电机驱动异常");

4.2.2 命令行控制日志

# 设置日志级别（只显示WARN及以上）
ros2 run my_package my_node --ros-args --log-level WARN

# 实时查看日志
ros2 run my_package my_node 2>&1 | tee log.txt

我记得有一次，仿真里车辆老是跑偏，查了半天代码没找到问题。后来把日志级别调到DEBUG，才发现是IMU的初始姿态没对齐。所以说，日志这东西，关键时刻能救命。

4.3 TF坐标变换基础

自动驾驶里，坐标变换无处不在。激光雷达在车顶，GPS天线在车尾，摄像头在挡风玻璃后——这些传感器数据要融合，必须统一到同一个坐标系下。TF就是干这个的。

4.3.1 TF树的概念

TF树说白了就是坐标系之间的父子关系图。比如：

map -> odom -> base_link -> laser_link
                         -> camera_link

每个坐标系都有一个父坐标系，通过变换（平移+旋转）关联起来。

4.3.2 常用TF命令

# 查看TF树
ros2 run tf2_tools view_frames.py

# 打印变换关系
ros2 run tf2_ros tf2_echo base_link laser_link

# 静态变换发布（比如激光雷达相对于车体的固定位置）
ros2 run tf2_ros static_transform_publisher 0.5 0 0.3 0 0 0 base_link laser_link

4.3.3 代码中的TF使用

// C++示例：监听变换
geometry_msgs::msg::TransformStamped transform;
try {
    transform = tf_buffer->lookupTransform(
        "base_link", "laser_link", tf2::TimePointZero);
} catch (tf2::TransformException &ex) {
    RCLCPP_WARN(logger, "TF异常: %s", ex.what());
}

4.4 本章知识体系

下面这张图，是我梳理的本章核心逻辑。你可以把它当成调试时的「作战地图」：

这张图把本章内容串起来了。你调试时，就按这个顺序走：先看数据对不对，再查服务通不通，录个bag留证据，翻日志找线索，最后确认坐标变换有没有配错。这套流程我用了好几年，基本没失手过。

好了，这一章就聊到这儿。工具链这东西，光看没用，得动手敲。下次遇到问题，别慌，打开终端，用这些命令查一查，你会发现——原来问题这么简单。