4. 地图服务与TF树：地图服务器配置、TF树原理与静态/动态TF发布

各位同学，欢迎来到第四章。前面我们搞定了机器人的建模和传感器数据，但机器人要导航，首先得知道自己「在哪」以及「周围长什么样」。这一章，我们就来聊聊这两个核心问题：地图服务（map_server）和TF坐标变换树。

说实话，这两块内容在ROS2里是「搭台子」的活儿。台子搭不好，后面的导航全是空中楼阁。我自己刚接触Nav2时，就因为在TF树上少配了一个静态变换，结果机器人定位直接飘到外太空去了……嗯，咱们今天就把这些坑提前填上。

4.1 地图服务器（map_server）配置

map_server，顾名思义，就是负责把地图文件喂给ROS2系统的节点。它支持两种主流地图格式：occupancy grid（占据栅格图）和YAML配置文件。

4.1.1 地图文件结构

一张完整的地图，通常包含两个文件：

• 地图图片（.pgm / .png）：灰度图，白色代表可通行区域，黑色代表障碍物，灰色代表未知区域。
• YAML配置文件：告诉map_server这张图的元信息。

来看一个典型的YAML配置：

image: my_map.pgm
resolution: 0.05
origin: [-10.0, -10.0, 0.0]
occupied_thresh: 0.65
free_thresh: 0.196
negate: 0

这里我重点解释几个参数：

• resolution：每个像素代表多少米。0.05就是5厘米一格。这个值越小，地图越精细，但计算量也越大。
• origin：地图左下角在真实世界坐标系下的位置（x, y, yaw）。注意，这个原点通常和机器人的起始位置对齐。
• occupied_thresh / free_thresh：像素灰度值到占据概率的映射阈值。说白了，就是多黑算障碍物，多白算空地。

4.1.2 启动map_server

在ROS2中，启动map_server有两种方式：

方式一：命令行直接启动

ros2 run nav2_map_server map_server --ros-args -p yaml_filename:=/path/to/my_map.yaml

方式二：在launch文件中集成

from launch import LaunchDescription
from launch_ros.actions import Node

def generate_launch_description():
    return LaunchDescription([
        Node(
            package='nav2_map_server',
            executable='map_server',
            name='map_server',
            parameters=[{'yaml_filename': '/path/to/my_map.yaml'}]
        )
    ])

我个人习惯用launch文件，因为后面还要叠加生命周期管理（LifecycleNode），launch文件更方便统一控制。

4.1.3 地图服务的生命周期

map_server在Nav2中是一个生命周期节点。它有几个状态：

• Unconfigured：刚启动，还没加载地图。
• Inactive：地图已加载，但还没发布。
• Active：正常发布地图话题。
• Finalized：节点销毁。

为什么要搞这么复杂？因为导航系统启动时，需要等所有组件都就绪了再开始工作。生命周期管理可以保证「地图加载完毕 → 定位启动 → 规划器启动」这个顺序不乱套。

4.2 TF树原理

TF（Transform）是ROS2里最基础也最重要的概念之一。说白了，TF就是用来回答「A坐标系下的点，在B坐标系下是什么位置？」这个问题。

4.2.1 为什么需要TF树？

你想想看，一个机器人身上有激光雷达、摄像头、轮子、机械臂……每个传感器都有自己的坐标系。激光雷达测到的障碍物距离，是相对于激光雷达本身的。但导航需要知道这个障碍物相对于机器人底盘的位置，甚至相对于地图原点的位置。

TF树就是把这些坐标系之间的变换关系串起来，形成一棵树。每个节点代表一个坐标系，每条边代表一个变换（平移+旋转）。

4.2.2 常见的TF坐标系

坐标系名称	含义	父坐标系
map	地图坐标系，固定不变	无（根节点）
odom	里程计坐标系，随机器人移动漂移	map
base_link	机器人底盘中心	odom
base_laser	激光雷达安装位置	base_link
base_camera	摄像头安装位置	base_link

这里要注意：map → odom → base_link 这条链路是导航的命脉。map到odom的变换由定位模块（如AMCL）发布，odom到base_link的变换由里程计发布。

4.2.3 TF树的结构图

下面我用一张SVG图来展示典型的机器人TF树结构：

从这张图可以看得很清楚：map是根节点，所有变换最终都要追溯到map。如果某个传感器没有正确挂接到base_link上，TF树就会断掉，导航系统直接罢工。

4.3 静态TF与动态TF发布

TF变换分为两类：静态TF和动态TF。它们的区别在于：静态TF发布一次就不变了，动态TF需要持续更新。

4.3.1 静态TF发布

静态TF用于描述固定不变的坐标系关系。比如激光雷达相对于机器人底盘的位置，装上去之后就不会动了。

发布静态TF有两种方式：

方式一：命令行工具

ros2 run tf2_ros static_transform_publisher 0.2 0.0 0.15 0.0 0.0 0.0 base_link base_laser

这行命令的意思是：base_laser相对于base_link，在x方向偏移0.2米，y方向0米，z方向0.15米，旋转角度全为0。

方式二：在launch文件中声明

Node(
    package='tf2_ros',
    executable='static_transform_publisher',
    arguments=['0.2', '0.0', '0.15', '0.0', '0.0', '0.0', 'base_link', 'base_laser']
)

4.3.2 动态TF发布

动态TF用于描述随时间变化的坐标系关系。最典型的就是里程计发布的odom→base_link变换。

动态TF需要在代码中实时计算并发布。来看一个简单的里程计TF发布示例：

import rclpy
from rclpy.node import Node
from tf2_ros import TransformBroadcaster
from geometry_msgs.msg import TransformStamped

class OdomTFPublisher(Node):
    def __init__(self):
        super().__init__('odom_tf_publisher')
        self.tf_broadcaster = TransformBroadcaster(self)
        self.timer = self.create_timer(0.05, self.publish_tf)  # 20Hz

    def publish_tf(self):
        t = TransformStamped()
        t.header.stamp = self.get_clock().now().to_msg()
        t.header.frame_id = 'odom'
        t.child_frame_id = 'base_link'
        # 这里假设从里程计数据中获取了位置和姿态
        t.transform.translation.x = 0.0
        t.transform.translation.y = 0.0
        t.transform.translation.z = 0.0
        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.tf_broadcaster.sendTransform(t)

这段代码的核心逻辑是：每个周期都要重新计算变换，并打上时间戳。为什么时间戳这么重要？因为TF系统会根据时间戳来插值，如果你发布的时间戳是乱的，其他节点查TF时就会得到错误的结果。

4.3.3 静态TF vs 动态TF：什么时候用哪个？

类型	适用场景	发布频率	示例
静态TF	传感器安装位置、车轮位置等固定关系	1Hz（自动重复）	base_link → base_laser
动态TF	里程计、定位、关节运动等变化关系	10~100Hz（手动控制）	odom → base_link

我个人建议：能用静态TF就别用动态TF。静态TF简单、可靠、不出错。动态TF一旦写不好，就是各种玄学bug的源头。

4.4 本章小结

这一章我们聊了三件事：

• 地图服务器：怎么配YAML、怎么启动、生命周期怎么管理。
• TF树原理：坐标系之间的父子关系，以及map→odom→base_link这条黄金链路。
• 静态与动态TF：什么时候用哪个，代码怎么写，时间戳为什么重要。

说实话，TF树是ROS2里最容易出问题的地方之一。很多新手一上来就遇到「No transform available」的错误，其实就是某个坐标系没挂上。我的建议是：先画好TF树结构图，再动手写代码。结构清晰了，代码自然不容易出错。