ROS2 中的 TF 系统：机器人坐标系管理

2. 发布静态变换（Static Transform）

from tf2_ros.static_transform_broadcaster import StaticTransformBroadcaster

class StaticFramePublisher(Node):
    def __init__(self):
        super().__init__('static_frame_publisher')
        self.static_br = StaticTransformBroadcaster(self)
        
        # 只需要发布一次
        static_transform = TransformStamped()
        static_transform.header.stamp = self.get_clock().now().to_msg()
        static_transform.header.frame_id = 'base_link'
        static_transform.child_frame_id = 'camera_link'
        
        static_transform.transform.translation.x = 0.5
        static_transform.transform.translation.y = 0.0
        static_transform.transform.translation.z = 0.3  # 修正笔误
        
        # 相机朝向（旋转 90 度）
        static_transform.transform.rotation.x = 0.0
        static_transform.transform.rotation.y = 0.0
        static_transform.transform.rotation.z = 0.707
        static_transform.transform.rotation.w = 0.707
        
        self.static_br.sendTransform(static_transform)

3. 监听变换（Transform Listener）

import tf2_ros
from tf2_ros import LookupException, ConnectivityException, ExtrapolationException

class FrameListener(Node):
    def __init__(self):
        super().__init__('frame_listener')
        # 创建 Buffer 和 Listener
        self.tf_buffer = tf2_ros.Buffer()
        self.tf_listener = tf2_ros.TransformListener(self.tf_buffer, self)
        self.timer = self.create_timer(1.0, self.lookup_transform)

    def lookup_transform(self):
        try:
            # 查询从 'base_link' 到 'laser' 的变换
            transform = self.tf_buffer.lookup_transform(
                'base_link',  # 目标坐标系
                'laser',      # 源坐标系
                rclpy.time.Time()  # 最新时间
            )
            self.get_logger().info(
                f"Translation: [{transform.transform.translation.x:.2f}, "
                f"{transform.transform.translation.y:.2f}, "
                f"{transform.transform.translation.z:.2f}]"
            )
        except (LookupException, ConnectivityException, ExtrapolationException) as e:
            self.get_logger().warn(f'Could not transform: {str(e)}')

常用工具

命令行工具

# 查看当前 TF 树
ros2 run tf2_tools view_frames

# 查询特定变换
ros2 run tf2_ros tf2_echo base_link laser

# 发布静态变换
ros2 run tf2_ros static_transform_publisher 0 0 1 0 0 0 base_link camera

RViz2 可视化

在 RViz2 中添加 TF 显示插件，可以实时可视化坐标系：

• 红色 = X 轴
• 绿色 = Y 轴
• 蓝色 = Z 轴

ROS 1 vs ROS 2 TF 对比

最佳实践

1. 区分静态/动态变换：固定关系用 StaticTransformBroadcaster，减少网络负载
2. 保持时间同步：确保所有节点使用相同的时间源（ROS 时间 vs 系统时间）
3. 异常处理：查询变换时总是捕获可能的异常
4. 命名规范：使用 REP 105 标准坐标系命名（map→odom→base_link）
5. 避免环形依赖：TF 树必须是严格的树形结构，不能闭环

典型应用场景

• 传感器数据融合：将激光雷达、相机数据转换到统一坐标系
• 导航规划：将目标点从地图坐标系转换到机器人坐标系
• 机械臂控制：计算末端执行器相对于基座的位姿
• 多机器人协作：统一不同机器人的坐标参考系