4、静态TF广播器：编写第一个静态坐标变换发布节点

说实话，刚接触TF的时候，我总觉得坐标变换是个挺玄乎的东西。但后来发现，静态TF广播器就是整个TF树的“地基”。你想想看，机器人身上那些固定不动的部件——比如激光雷达装在底盘上，摄像头固定在支架上——它们之间的相对位置永远不会变。这种“一辈子不变”的变换，就是静态TF要干的事。

我个人习惯把静态TF比作“焊接”。一旦焊死，坐标关系就锁死了。今天我们就来写第一个静态坐标变换发布节点，用C++和Python各撸一遍。代码不长，但背后的逻辑值得细品。

4.1 静态广播 vs 动态广播 —— 一句话说清

很多初学者会问：“静态TF和动态TF到底有啥区别？” 我直接给你个结论：静态TF只发布一次，或者以极低频率重复发布；动态TF每一帧都可能变。静态TF适合“焊死”的关系，动态TF适合关节运动。

但注意了——ROS2里，静态TF广播器其实会以50Hz的频率重复发布同一变换。为什么？因为后来的监听器可能刚上线，需要拿到最新的变换。嗯，这里要记住：静态不代表只发一次，而是变换数值不变。

4.2 编写C++静态TF广播节点

我们直接创建一个ROS2功能包，然后写节点。我个人偏爱C++，因为性能稳，调试也直接。

步骤1：创建功能包

cd ~/ros2_ws/src
ros2 pkg create tf_static_broadcaster_cpp --build-type ament_cmake --dependencies rclcpp tf2 tf2_ros geometry_msgs

步骤2：编写节点代码 在 src/static_tf_broadcaster.cpp 中写入：

#include <rclcpp/rclcpp.hpp>
#include <tf2_ros/static_transform_broadcaster.h>
#include <geometry_msgs/msg/transform_stamped.hpp>

class StaticTFBroadcaster : public rclcpp::Node
{
public:
    StaticTFBroadcaster() : Node("static_tf_broadcaster")
    {
        broadcaster_ = std::make_shared<tf2_ros::StaticTransformBroadcaster>(this);

        geometry_msgs::msg::TransformStamped transform;
        transform.header.stamp = this->now();
        transform.header.frame_id = "base_link";
        transform.child_frame_id = "laser_frame";

        transform.transform.translation.x = 0.2;
        transform.transform.translation.y = 0.0;
        transform.transform.translation.z = 0.4;

        transform.transform.rotation.x = 0.0;
        transform.transform.rotation.y = 0.0;
        transform.transform.rotation.z = 0.0;
        transform.transform.rotation.w = 1.0;

        broadcaster_->sendTransform(transform);
        RCLCPP_INFO(this->get_logger(), "静态TF已发布: base_link -> laser_frame");
    }

private:
    std::shared_ptr<tf2_ros::StaticTransformBroadcaster> broadcaster_;
};

int main(int argc, char *argv[])
{
    rclcpp::init(argc, argv);
    rclcpp::spin(std::make_shared<StaticTFBroadcaster>());
    rclcpp::shutdown();
    return 0;
}

步骤3：编译与运行

cd ~/ros2_ws
colcon build --packages-select tf_static_broadcaster_cpp
source install/setup.bash
ros2 run tf_static_broadcaster_cpp static_tf_broadcaster

看到终端输出“静态TF已发布”就成功了。你可以另开终端用 ros2 topic echo /tf_static 查看发布的内容。

4.3 Python版本 —— 更简洁，适合快速验证

如果你喜欢Python的轻快，下面这个节点同样能干。我在原型阶段经常用Python，改起来快。

import rclpy
from rclpy.node import Node
from tf2_ros.static_transform_broadcaster import StaticTransformBroadcaster
from geometry_msgs.msg import TransformStamped

class StaticTFBroadcasterPy(Node):
    def __init__(self):
        super().__init__('static_tf_broadcaster_py')
        self.broadcaster = StaticTransformBroadcaster(self)

        t = TransformStamped()
        t.header.stamp = self.get_clock().now().to_msg()
        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.4

        t.transform.rotation.x = 0.0
        t.transform.rotation.y = 0.0
        t.transform.rotation.z = 0.0
        t.transform.rotation.w = 1.0

        self.broadcaster.sendTransform(t)
        self.get_logger().info('Python静态TF广播器已启动')

def main(args=None):
    rclpy.init(args=args)
    node = StaticTFBroadcasterPy()
    rclpy.spin(node)
    rclpy.shutdown()

if __name__ == '__main__':
    main()

运行方式类似，别忘了在 setup.py 里配好入口点。我个人习惯把Python节点放在 tf_static_broadcaster_py 包里。

4.4 核心逻辑图解

下面这张SVG图帮你把静态TF广播的整个数据流串起来。看一眼就明白节点、话题、TF树之间的关系。

4.5 验证你的静态TF

节点跑起来之后，用下面几个命令确认一切正常：

• ros2 topic echo /tf_static —— 查看发布的静态变换内容
• ros2 run tf2_tools view_frames.py —— 生成TF树PDF，看看 base_link 和 laser_frame 是否连在一起
• ros2 run tf2_ros tf2_echo base_link laser_frame —— 直接打印两个坐标系的实时变换

4.6 避坑指南 & 最佳实践

• 时间戳必须赋值：静态TF虽然数值不变，但 stamp 不能为0。我见过有人忘了设时间戳，结果监听器一直拿不到变换。
• 不要用 tf2_ros::TransformBroadcaster 发静态变换：虽然也能发，但效率低。静态变换有专门的 StaticTransformBroadcaster，内部做了优化。
• 命名规范：frame_id 用下划线命名法，比如 front_laser，不要用驼峰。ROS社区约定俗成。
• 我曾经犯过的错：在回调函数里每次调用 sendTransform，结果每秒发几千次，CPU直接飙到80%。静态TF只需要在初始化时发一次，或者用专门的静态发布工具。