4. TF监听器与广播器：API详解、创建与使用

说到 TF，最核心的两个角色就是 广播器 和 监听器。一个负责发布坐标变换，一个负责接收并缓存。你想想看，没有广播器，坐标帧就没人知道；没有监听器，你拿到变换数据也没处用。这俩就像一对搭档，缺一不可。

我个人习惯把广播器想象成「喊话的人」，监听器是「竖起耳朵听的人」。在 ROS 里，tf2_ros 包提供了非常清爽的 API。今天我们就把它俩的底裤扒干净——怎么创建、怎么用、有哪些坑。

4.1 TFBroadcaster —— 广播变换

广播器的作用说白了就一个：把两个坐标系之间的变换关系扔到 /tf 话题上。ROS 2 里用的是 tf2_ros::TransformBroadcaster，ROS 1 也一样，只是命名空间略有不同。我最早用的时候老搞混 sendTransform 的参数顺序，后来养成了习惯——先写子帧，再写父帧。

来看一个最典型的广播例子。假设我们有一个激光雷达帧 laser_frame，它相对于机器人基座 base_link 的偏移是 (0.2, 0.0, 0.3)，四元数表示无旋转。

// C++ 示例 (ROS 2)
#include <tf2_ros/transform_broadcaster.h>
#include <geometry_msgs/msg/transform_stamped.hpp>

tf2_ros::TransformBroadcaster broadcaster;
geometry_msgs::msg::TransformStamped t;

t.header.stamp = this->get_clock()->now();
t.header.frame_id = "base_link";      // 父帧
t.child_frame_id = "laser_frame";     // 子帧

t.transform.translation.x = 0.2;
t.transform.translation.y = 0.0;
t.transform.translation.z = 0.3;
t.transform.rotation.x = 0.0;
t.transform.rotation.y = 0.0;
t.transform.rotation.z = 0.0;
t.transform.rotation.w = 1.0;

broadcaster.sendTransform(t);

4.2 TFListener —— 监听与查询变换

监听器比广播器稍微复杂一丢丢。它内部维护一个 Buffer，所有收到的变换都缓存起来。你可以通过 lookupTransform 查询任意两帧之间的变换，也可以先调用 canTransform 确认是否可用。

我建议你永远不要假设变换一定存在。机器人刚启动时，TF 树还没建好，直接 lookupTransform 会抛异常。所以稳健的做法是先 canTransform 再查，或者用 try-catch 兜底。

// 监听器典型用法 (ROS 2)
#include <tf2_ros/buffer.h>
#include <tf2_ros/transform_listener.h>

tf2_ros::Buffer buffer(this->get_clock());
tf2_ros::TransformListener listener(buffer);

// 在回调或循环里查询
geometry_msgs::msg::TransformStamped transformStamped;
try {
    transformStamped = buffer.lookupTransform(
        "base_link",          // 目标帧
        "odom",               // 源帧
        tf2::TimePointZero);  // 取最新变换
} catch (tf2::TransformException & ex) {
    RCLCPP_WARN(this->get_logger(), "变换查询失败: %s", ex.what());
}

4.3 创建广播器与监听器的完整步骤

不管你是用 C++ 还是 Python，套路都差不多。我习惯把广播器和监听器声明为类成员，这样生命周期好控制。

1. 包含头文件：tf2_ros/transform_broadcaster.h 和 tf2_ros/transform_listener.h。
2. 创建 Buffer 和 Listener：Buffer 必须先于 Listener 构造，因为 Listener 构造时会依赖 Buffer。
3. 创建 Broadcaster：直接实例化，之后随时调用 sendTransform。
4. 在循环或定时器里广播/查询：注意时间戳一致性。

import rclpy
from tf2_ros import TransformBroadcaster, Buffer, TransformListener

buffer = Buffer()
listener = TransformListener(buffer)
broadcaster = TransformBroadcaster(node)

# 广播
t = TransformStamped()
t.header.stamp = node.get_clock().now().to_msg()
t.header.frame_id = 'base_link'
t.child_frame_id = 'laser_frame'
# ... 填充 translation, rotation
broadcaster.sendTransform(t)

# 监听
try:
    trans = buffer.lookup_transform('base_link', 'odom', rclpy.time.Time())
except Exception as e:
    node.get_logger().warn(f'失败: {str(e)}')

4.4 广播器与监听器的生命周期管理

嗯，这里要注意。广播器如果被析构了，它就不再发送变换。但监听器不一样——Buffer 里缓存的变换不会因为 Listener 析构而立刻消失，但新变换不会再进来了。所以如果你在多个节点里共享同一个 Buffer，一定要确保 Listener 一直活着。

我记得有一次做多传感器融合，我在一个临时作用域里创建了 Listener，结果变换查不到，排查了半天才发现 Listener 已经销毁了。从那以后，我都是把 Listener 和 Buffer 声明为节点的成员变量。