《自主移动机器人技术》课件-项目4 机器人坐标变换（TF）应用

ROS2坐标变换：理论与实践应用2026年7月8日CONTENTS目录01

坐标变换简介02

坐标相关消息03

坐标变换广播04

坐标变换监听CONTENTS目录05

坐标变换工具06

坐标变换实操：乌龟跟随07

坐标变换实操：乌龟护航08

本章小结01坐标变换简介坐标变换的概念与作用坐标变换的核心概念坐标变换（tf/tf2）是ROS中用于随时间跟踪多个坐标系关系的模块，通过树状结构维护坐标系间的动态或静态关联，支持任意坐标系间点、向量的转换。机器人系统中的意义在机器人系统中，坐标变换用于描述不同部件（如传感器、机械臂）、机器人与环境（障碍物、出发点）、多机器人间的相对位置关系，是定位、导航与控制的基础。ROS2坐标变换的必要性直接使用传感器原始坐标（如雷达、摄像头）无法直接反映机器人整体或其他部件的位置，需通过坐标变换统一参考系，简化复杂坐标转换计算。坐标变换的应用场景

传感器数据转换场景雷达检测到障碍物坐标（雷达坐标系）需转换为底盘坐标系，已知雷达相对底盘偏移量（X:0.4m,Y:0m,Z:0.2m），通过坐标变换实现数据融合。

机械臂目标定位场景摄像头识别目标物坐标（摄像头坐标系）需转换为机械臂夹具坐标系，结合摄像头与夹具的相对位姿，实现精准夹取操作。

多机器人协作场景在机器人组队任务中，通过坐标变换实时获取各机器人相对位置，确保编队运动、避障及协同作业的准确性。

tf2与右手坐标系tf2的核心特点tf2是ROS2中的第二代坐标变换库，支持时间缓冲、动态坐标系跟踪，提供广播器（发布坐标系关系）与监听器（融合坐标系树并实现转换）接口。

右手坐标系规则以右手原点为基准，食指指向X轴正方向，中指指向Y轴正方向，大拇指指向Z轴正方向，ROS坐标变换严格遵循此规则。

坐标树结构tf2将多个坐标系关系融合为单根坐标树，广播器发布父子坐标系关系，监听器通过缓存数据实现任意坐标系间的转换，确保数据一致性。02坐标相关消息

TransformStamped消息01消息定义格式通过命令`ros2interfaceshowgeometry_msgs/msg/TransformStamped`可查看完整定义，包含头信息、父子坐标系及位姿数据。

02头信息（Header）包含时间戳（stamp）和父坐标系ID（frame_id），用于标识消息发布时间及参考坐标系。

03父子坐标系关系通过`child_frame_id`指定子坐标系，描述子坐标系相对于父坐标系的位姿关系。

04位姿数据（Transform）包含三维平移量（translation.x/y/z）和四元数旋转（rotation.x/y/z/w），用于精确表示坐标系间的相对位置与姿态。

05核心作用作为坐标变换的核心消息载体，用于广播静态或动态坐标系间的相对关系，是TF2框架中坐标系树构建的基础。01PointStamped消息消息结构组成通过命令`ros2interfaceshowgeometry_msgs/msg/PointStamped`查看定义，由头信息（Header）和三维坐标点（Point）组成。02参考系标识（Header.frame_id）指定坐标点所在的参考坐标系，确保坐标点数据的空间基准唯一性。03三维坐标数据（Point）包含x、y、z三个浮点型参数，分别表示坐标点在参考坐标系中的三维位置。04时间戳（Header.stamp）记录坐标点数据的采集时间，支持TF2框架中基于时间的坐标变换查询。05典型应用场景用于发布传感器检测到的障碍物坐标（如激光雷达点云）、目标物位置等，需结合TF2监听实现跨坐标系转换。03坐标变换广播静态坐标系相对关系概念静态坐标变换广播静态坐标系相对关系指两个坐标系间相对位置固定不变，如车辆上固定式雷达、摄像头与底盘坐标系的关系。静态广播器工具实现通过tf2_ros功能包的static_transform_publisher工具，可直接广播静态坐标变换。格式1：指定x/y/z偏移量和roll/pitch/yaw旋转；格式2：指定x/y/z偏移量和四元数。例如发布雷达相对底盘的变换：ros2runtf2_rosstatic_transform_publisher--x0.4--y0--z0.2--yaw0--roll0--pitch0--frame-idbase_link--child-frame-idlaser。C++实现静态广播流程包括包含头文件、判断参数合法性、初始化ROS客户端、定义节点类（创建静态广播器、组织并发布消息）、调用spin函数及释放资源。需编辑package.xml和CMakeLists.txt，编译后执行命令发布坐标变换。

静态坐标变换广播Python实现静态广播步骤为导包、判断参数合法性、初始化ROS客户端、定义节点类（创建静态广播器、组织并发布消息）、调用spin函数及释放资源。修改setup.py，编译后执行命令发布坐标变换。

rviz2查看坐标系关系启动rviz2，将GlobalOptions中的FixedFrame设为base_link，添加TF插件并勾选ShowNames，可图形化显示坐标系关系。动态坐标系相对关系特点动态坐标变换广播

动态坐标系相对关系指两个坐标系间相对位置动态改变，如机械臂关节、多车编队中车辆坐标系的关系。C++实现动态广播（乌龟案例）

步骤包括包含头文件、初始化ROS客户端、定义节点类（创建动态广播器、乌龟位姿订阅方、根据位姿生成并广播坐标帧）、调用spin函数及释放资源。编译后启动turtlesim_node、turtle_teleop_key和动态广播节点，通过键盘控制乌龟运动，rviz2中可查看实时更新的坐标系关系。Python实现动态广播（乌龟案例）

流程为导包、初始化ROS客户端、定义节点类（创建动态广播器、乌龟位姿订阅方、根据位姿生成并广播坐标帧）、调用spin函数及释放资源。修改setup.py，编译后执行相关命令，控制乌龟运动可在rviz2中观察坐标系实时变化。坐标点发布坐标点发布实现流程包括编写话题发布实现、编辑配置文件、编译、执行及在rviz2中查看结果。C++实现坐标点发布步骤为包含头文件、初始化ROS客户端、定义节点类（创建坐标点发布方、定时器、组织并发布坐标点消息）、调用spin函数及释放资源。编译后发布雷达相对底盘的静态坐标变换和障碍物坐标点，在rviz2中添加PointStamped插件查看结果。Python实现坐标点发布流程为导包、初始化ROS客户端、定义节点类（创建坐标点发布方、定时器、组织并发布坐标点消息）、调用spin函数及释放资源。修改setup.py，编译后执行相关命令发布坐标点，在rviz2中查看发布结果。04坐标变换监听

坐标系变换坐标系变换实现方法坐标系变换需基于已广播的坐标系关系，通过监听并融合多组坐标系相对关系为坐标树，调用相关API实现不同坐标系间的变换。

C++实现坐标系变换监听创建tf缓存对象和监听器，通过定时器循环查找指定坐标系关系，使用lookupTransform函数获取变换结果，处理可能的LookupException异常。

Python实现坐标系变换监听初始化缓存和监听器，利用定时器判断坐标系是否可变换，调用lookup_transform函数获取变换数据，输出父坐标系、子坐标系及偏移量信息。坐标点变换坐标点变换概述坐标点变换是将某一坐标系下的坐标点转换到另一坐标系，需结合坐标变换关系，可通过消息过滤器等工具实现，常用于传感器数据转换。C++实现坐标点变换创建坐标点订阅方和消息过滤器，注册回调函数，在回调中调用transform函数将坐标点转换到目标坐标系，处理TransformException异常。坐标点变换异常处理常见异常包括坐标系不存在、变换超时等，通过try-catch捕获异常并输出提示信息，确保程序稳定运行，便于调试和问题定位。05坐标变换工具

tf2_monitor工具工具功能概述tf2_monitor是tf2_ros功能包提供的工具，用于监测坐标系广播的发布频率与网络延迟，帮助开发者评估坐标变换数据的实时性与稳定性。

打印所有坐标系信息执行命令“ros2runtf2_rostf2_monitor”，可收集10秒内所有坐标系数据，输出各坐标系的平均延迟、最大延迟及广播节点的发布频率，如“Frame:laser,AverageDelay:23152.5,MaxDelay:23152.5”。

打印指定坐标系信息通过命令“ros2runtf2_rostf2_monitor父坐标系子坐标系”，可查看特定坐标系对的变换延迟，如“ros2runtf2_rostf2_monitorcameralaser”输出camera到laser的平均延迟与最大延迟。

tf2_echo工具工具功能说明tf2_echo用于实时打印两个坐标系之间的平移和旋转关系，直观展示坐标系间的位姿变换参数，支持四元数、RPY角（弧度/角度）及变换矩阵格式输出。

基本使用方法命令格式：“ros2runtf2_rostf2_echo父坐标系子坐标系”，例如“ros2runtf2_rostf2_echoworldturtle1”，实时输出turtle1相对于world坐标系的平移（x,y,z）和旋转信息。

输出信息示例典型输出包含时间戳、平移量（如“Translation:[7.234,8.450,0.000]”）、旋转四元数（如“Quaternion[0.000,0.000,0.671,0.741]”）及RPY角（如“RPY(degree)[0.000,-0.000,84.339]”）。

view_frames工具01工具核心作用view_frames是tf2_tools功能包提供的工具，通过生成包含坐标系关系的PDF文件，以树形图形式可视化展示所有坐标系的层级结构，辅助理解坐标系间的拓扑关系。

02使用步骤与输出执行命令“ros2runtf2_toolsview_frames”，工具将扫描当前广播的坐标系关系，生成“frames_xxxx.gv”（Graphviz文件）和“frames_xxxx.pdf”（PDF图谱），其中xxxx为时间戳。

03图谱内容说明PDF文件包含坐标系树状图，显示各坐标系的父子关系、发布节点及发布频率，例如以world为根节点，下属turtle1、laser等子坐标系，清晰呈现坐标变换的整体架构。06坐标变换实操：乌龟跟随

案例需求与分析案例需求程序运行后启动turtlesim_node节点，生成窗口及原生乌龟turtle1，再生成新乌龟turtle2。无论turtle1静止或被键盘控制运动，turtle2均以turtle1为目标向其运动。

案例分析核心是确定turtle1相对turtle2的位置，通过坐标变换实现。思路为：分别广播turtle1与turtle2相对于world的坐标系关系，监听这些关系获取turtle1相对turtle2的坐标系关系，进而控制turtle2运动。

流程简介编写程序调用/spawn服务生成新乌龟；编写坐标变换广播实现，广播turtle1和turtle2相对world的坐标系关系；编写坐标变换监听实现，获取相对关系并生成turtle2速度指令；编写launch文件集成节点；编辑配置文件、编译、执行。C++实现乌龟跟随生成新乌龟实现创建客户端发送请求生成新乌龟，步骤包括包含头文件、初始化ROS客户端、定义节点类（声明获取参数、创建客户端、等待服务连接、组织发送请求）、处理响应、释放资源。坐标变换广播实现发布乌龟坐标系到窗口坐标系的变换，步骤有包含头文件、初始化ROS客户端、定义节点类（声明解析乌龟名称参数、创建动态坐标变换发布方、创建乌龟位姿订阅方、根据位姿生成并广播坐标帧）、调用spin函数、释放资源。坐标变换监听实现广播坐标系消息，生成turtle2相对turtle1的坐标系数据并生成速度指令。步骤为包含头文件、初始化ROS客户端、定义节点类（声明解析参数、创建tf缓存和监听器、查找坐标系变换、生成并发布速度指令）、调用spin函数、释放资源。C++实现乌龟跟随

launch文件编写与执行编写launch文件集成相关节点，包括声明参数、启动turtlesim_node节点、生成新乌龟、启动坐标变换广播和监听节点。编译功能包后，运行launch文件，启动键盘控制节点，实现turtle2跟随turtle1运动。

Python实现乌龟跟随生成新乌龟实现编写客户端发送请求生成新乌龟，步骤包括导包、初始化ROS客户端、定义节点类（声明获取参数、创建客户端、等待服务连接、组织发送请求）、处理响应、释放资源。

坐标变换广播实现发布乌龟坐标系到窗口坐标系的变换，步骤有导包、初始化ROS客户端、定义节点类（声明解析乌龟名称参数、创建动态坐标变换发布方、创建乌龟位姿订阅方、根据位姿生成并广播坐标帧）、调用spin函数、释放资源。

坐标变换监听实现广播坐标系消息，生成turtle2相对turtle1的坐标系数据并生成速度指令。步骤为导包、初始化ROS客户端、定义节点类（声明解析参数、创建tf缓存和监听器、查找坐标系变换、生成并发布速度指令）、调用spin函数、释放资源。

launch文件编写与执行编写launch文件集成相关节点，包括启动turtlesim_node节点、生成新乌龟、启动坐标变换广播和监听节点。编译功能包后，运行launch文件，启动键盘控制节点，实现turtle2跟随turtle1运动。07坐标变换实操：乌龟护航

案例需求与分析案例需求生成多只乌龟，以turtlesim_node的原生乌龟(turtle1)为中心，无论turtle1是静止或运动时，都以某种队形为turtle1护航。

实现核心分析把队形中每个点位看作一个坐标系，这些坐标系相对于turtle1坐标系的关系是静态的，通过静态广播器发布这些点与turtle1的坐标系关系。在坐标系关系树中，已知点坐标系到turtle1坐标系、turtle1坐标系到world坐标系、护航乌龟坐标系到world坐标系的关系，可换算出护航乌龟坐标系与其对应点坐标系的相对关系，进而计算并发布控制护航乌龟运动的速度指令。

C++实现乌龟护航编写launch文件功能包cpp05_exercise的launch目录下新建exer02_turtle_escort.launch.py文件，集成相关节点，包括启动turtlesim_node节点，生成新乌龟，进行tf广播、静态坐标变换发布和tf监听等。

编译终端中进入当前工作空间，执行命令“colconbuild--packages-selectcpp05_exercise”编译功能包。

执行当前工作空间下启动终端，输入命令“.install/setup.bash”和“ros2launchcpp05_exerciseexer02_turtle_escort.launch.py”运行launch文件。窗口中会新生成三只乌龟，向原生乌龟turtle1运动并组成固定队形，通过键盘控制turtle1运动时，护航乌龟会按特定队形跟随。

Python实现乌龟护航

编写launch文件功能包py05_exercise的launch目录下新建exer02_turtle_escort.launch.xml文件，集成相关节点，包括乌龟准备、发布坐标变换、发布乌龟目标坐标和监听坐标变换等。

编译终端中进入当前工作空间，执行命令“colconbuild--packages-selectpy05_exercise”编译功能包。

执行当前工作空间下启动终端，输入命令“.install/setup.bash”和“ros2launchpy05_exerciseexer02_turtle_escort.launch.xml”运行launch文件。窗口中会新生成三只乌龟，向原生乌龟turtle1运动并组成固定队形，通过键盘控制turtle1运动时，护航乌龟会按特定队形跟随。08本章小结

核心知识点回顾坐标变换核心消息坐标变换依赖两种关键消息：geometry_msgs/msg/TransformStamped用于描述某一时刻两个坐标系间的相对关系，包含平移和旋转信息；geometry_msgs/msg/PointStamped用于描述某一时刻坐标系内坐标点的位置，含参考坐标系和三维坐标数据。

坐标变换广播机制广播分为静态广播和动态广播。静态广播适用于固定坐标系关系，可通过tf2_ros工具或编码实现；动态广播用于实时变化的坐标系关系，需订阅位姿数据并持续发布变换消息。坐标点发布则通过话题发布PointStamped消息实现。

坐标变换监听实现监听通过tf2_ros的Buffer和TransformListener实现，可完成坐标系间变换及坐标点变换。坐标系变换需调用lookupTransform获取相对关系，坐标点变换可结合消息过滤器处理数据，实现不同坐标系下点的转换。核心知识点回顾

坐标变换与话题通信异同坐标变换本质是基于话题通信的发布订阅模型，接口消息、发布方（广播）、订阅方（监听）为核心要素。与一般话题通信不同，坐标变换广播消息需存入缓存并通过坐标系id和时间戳关联，监听方可利用这些关联处理数据。

工具与案例应用总结

常用坐标变换工具tf2_ros包提供static_transform_publisher（静态广播）、tf2_monitor（监控坐标系发布频率与延迟）、tf2_echo（打印坐标系平移旋转关系）；tf2_tools包的view_frames可生成坐标系关系图谱PDF文件，辅助开发调试。

乌龟跟随案例要点实现流程：调用/spawn服务生成新乌龟，广播turtle1与turtle2相对world的坐标系关系，监听turtle1相对turtle2的变换，生成速度指令控制turtle2运动。核心是通过坐标变换获取相对位置，结合PID控制实现跟随。

乌龟护航案例要点以turtle1为中心，通过静态广播发布护航点位相对turtle1的坐标系关系，监听护航乌龟与对应点位的变换，生成速度指令控制队形。关键是利用静态坐标系关系构建队形，动态更新护航乌龟位姿。

理论与实践结合意义工具使用提升开发效率，案例实践强化API应用能力。通过乌龟跟随与护航案例，将坐标变换理论转化为实际机器人控制逻辑，体现ROS2中坐标变换在多坐标系协作场景的核心作用。坐标变换的拓展思考

多机器人协作中的坐标变换在多机器人编队中，需实时广播各机器人相对全局坐标系或彼此间的动态坐标关系，通过监听实现队形保持、避障等协作任务，需解决时间同步与坐标系树维护问题。复杂环境下的坐标转换面对动态障碍物、传感器噪声等场景，需结合滤波算法（如卡尔曼滤波）优化坐标变换精度，同时考虑坐标系延迟补偿，确保机器人在复杂环境中定位与导航的