3、坐标系与TF变换：ROS TF树概念、静态与动态坐标变换、使用tf2_ros发布与监听变换、在Rviz中验证坐标系。

说到机器人导航，坐标系就是它的「世界观」。没有坐标系，激光雷达扫到的点云就是一堆无意义的数字，机器人也不知道自己在哪里、要去哪里。我刚开始接触ROS时，就被TF树绕晕过——明明数据都发了，Rviz里就是看不到点云，后来才发现是坐标系没对上。嗯，今天咱们就把这块硬骨头啃下来。

3.1 TF树：机器人的坐标系家谱

TF（Transform）是ROS里管理坐标系变换的核心机制。你可以把它想象成一张家谱图——每个坐标系都是一个家庭成员，TF树记录了它们之间的相对位置和姿态关系。

常见的坐标系包括：

• map：世界坐标系，固定不变，是全局定位的基准
• odom：里程计坐标系，由轮式编码器或IMU推算得到
• base_link：机器人本体坐标系，通常位于机器人中心
• laser：激光雷达坐标系，位于雷达安装位置
• camera：相机坐标系（如果用了视觉传感器）

我习惯把TF树比作「坐标系之间的翻译官」。激光雷达检测到障碍物时，数据是在laser坐标系下的；但导航模块需要知道障碍物在map坐标系下的位置。TF树就是负责完成这个翻译工作的。

3.2 静态坐标变换：固定不变的「亲戚关系」

静态变换是指两个坐标系之间的相对关系固定不变。比如激光雷达安装在机器人上的位置和角度，一旦装好就不会动了。这种变换用tf2_ros::StaticTransformBroadcaster来发布。

来看一个实际例子。假设激光雷达安装在机器人前方0.2米、高度0.1米处，朝前安装：

# 静态变换发布示例（C++）
#include <tf2_ros/static_transform_broadcaster.h>
#include <geometry_msgs/TransformStamped.h>

int main(int argc, char** argv) {
    ros::init(argc, argv, "static_tf_broadcaster");
    ros::NodeHandle nh;

    static tf2_ros::StaticTransformBroadcaster broadcaster;
    geometry_msgs::TransformStamped transform;

    transform.header.stamp = ros::Time::now();
    transform.header.frame_id = "base_link";
    transform.child_frame_id = "laser";

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

    tf2::Quaternion q;
    q.setRPY(0, 0, 0);  // 无旋转，朝前
    transform.transform.rotation.x = q.x();
    transform.transform.rotation.y = q.y();
    transform.transform.rotation.z = q.z();
    transform.transform.rotation.w = q.w();

    broadcaster.sendTransform(transform);
    ros::spin();
    return 0;
}

静态变换只需要发布一次，TF树会自动维护。你想想看，如果每次都要重复发布同样的变换，那多浪费资源？

3.3 动态坐标变换：会动的「亲戚关系」

动态变换就复杂多了。比如机器人在移动时，odom到base_link的变换会不断变化。这种变换用tf2_ros::TransformBroadcaster来发布，而且需要高频更新。

典型的动态变换发布流程：

1. 从里程计话题（/odom）获取当前位置和姿态
2. 构建TransformStamped消息
3. 设置header.frame_id为"odom"，child_frame_id为"base_link"
4. 以10-50Hz的频率持续发布

# 动态变换发布示例（Python）
import rospy
import tf2_ros
from geometry_msgs.msg import TransformStamped
from nav_msgs.msg import Odometry

def odom_callback(msg):
    br = tf2_ros.TransformBroadcaster()
    t = TransformStamped()

    t.header.stamp = msg.header.stamp
    t.header.frame_id = "odom"
    t.child_frame_id = "base_link"

    t.transform.translation.x = msg.pose.pose.position.x
    t.transform.translation.y = msg.pose.pose.position.y
    t.transform.translation.z = msg.pose.pose.position.z

    t.transform.rotation = msg.pose.pose.orientation

    br.sendTransform(t)

if __name__ == '__main__':
    rospy.init_node('odom_to_baselink_tf')
    rospy.Subscriber('/odom', Odometry, odom_callback)
    rospy.spin()

这里有个细节：动态变换的时间戳必须和原始数据一致，不能直接用rospy.Time.now()。我踩过这个坑——用当前时间戳发布变换，结果TF树的时间线全乱了，Rviz里看到的机器人位置一直在抖动。

3.4 监听变换：从TF树中「查户口」

发布变换只是第一步，更重要的是监听变换。导航模块需要知道「激光雷达检测到的点，在map坐标系下是什么位置」。这时候就要用tf2_ros::Buffer和tf2_ros::TransformListener。

监听变换的核心API：

方法	功能	使用场景
lookupTransform(target_frame, source_frame, time)	查询两个坐标系在指定时刻的变换	获取当前时刻的位姿关系
canTransform(target_frame, source_frame, time)	检查变换是否可用	在查询前做安全检查
transform(input, target_frame)	将数据从一个坐标系变换到另一个	点云、位姿等数据的坐标转换

# 监听变换示例（C++）
#include <tf2_ros/buffer.h>
#include <tf2_ros/transform_listener.h>
#include <geometry_msgs/PointStamped.h>

tf2_ros::Buffer tf_buffer;
tf2_ros::TransformListener listener(tf_buffer);

// 查询laser到map的变换
geometry_msgs::TransformStamped transform;
try {
    transform = tf_buffer.lookupTransform("map", "laser", ros::Time(0));
} catch (tf2::TransformException &ex) {
    ROS_WARN("TF查询失败: %s", ex.what());
    return;
}

// 将激光坐标系下的点变换到map坐标系
geometry_msgs::PointStamped laser_point;
laser_point.header.frame_id = "laser";
laser_point.point.x = 1.0;
laser_point.point.y = 0.5;
laser_point.point.z = 0.0;

geometry_msgs::PointStamped map_point;
tf_buffer.transform(laser_point, map_point, "map");

3.5 在Rviz中验证坐标系

代码写完了，怎么知道TF树对不对？Rviz就是最好的验证工具。我每次搭建新机器人时，第一步就是在Rviz里看TF树。

验证步骤：

1. 启动机器人驱动和TF发布节点
2. 打开Rviz：rosrun rviz rviz
3. 在左侧面板添加TF显示插件
4. 观察坐标系之间的层级关系和相对位置
5. 用查看TF树功能（rosrun tf2_tools view_frames.py）生成TF树PDF

在Rviz中，每个坐标系都会显示为一个坐标轴（红X、绿Y、蓝Z）。你可以通过以下方式验证：

• 位置检查：激光雷达坐标系应该在机器人本体的正确安装位置
• 方向检查：坐标轴方向是否符合预期（比如激光雷达Z轴朝上）
• 动态检查：移动机器人时，base_link相对于odom的位置是否平滑变化

3.6 本章知识体系

下面这张图总结了TF变换的核心流程和关系：

从这张图可以看出，TF变换的核心就是「发布-监听-应用」三个环节。静态变换用于固定安装的传感器，动态变换用于移动的机器人本体，监听变换则是所有导航算法的基石。