ros 移动机器人坐标系规范详解（Coordinate Frames for Mobile Robots）

最新推荐文章于 2025-04-11 21:13:25 发布

YRr YRr

最新推荐文章于 2025-04-11 21:13:25 发布

阅读量1k

点赞数 20

分类专栏： ROS 文章标签： ros

本文链接：https://blog.youkuaiyun.com/m0_73640344/article/details/146354147

版权

ROS 专栏收录该内容

91 篇文章

订阅专栏

ros 移动机器人坐标系规范详解（Coordinate Frames for Mobile Robots）

在移动机器人系统中，准确且一致的坐标系定义对于定位、导航和多机器人协作至关重要。本文将详细介绍移动机器人常用的坐标系（base_link、odom、map、earth）、其惯例、相互关系以及在多机器人环境中的应用与管理。

1. 引言（Introduction）

移动机器人在执行任务过程中，需要在不同的参考框架下确定自身的位置和姿态。合理的坐标系管理不仅确保了机器人的自主导航能力，还支持多机器人系统的协同工作。本文依据ROS（Robot Operating System）中的常见实践，结合相关标准（如REP 103 [1]），系统地阐述了各类坐标系的定义、用途及其相互关系。

2. 基础坐标系（Basic Coordinate Frames）

2.1 base_link 坐标系

base_link 坐标系是固定在移动机器人底座（Robot Base）上的刚性坐标系，其主要特征包括：

固定性（Fixedness）：与机器人底座紧密结合，不随机器人运动而变化。
任意附着（Arbitrary Attachment）：base_link 可以在底座上的任意位置和方向附着，具体取决于硬件平台设计和参考点选择。
标准化方向（Standardized Orientation）：根据REP 103规范，base_link 通常遵循右手坐标系，X轴指向前方（Forward），Y轴指向左侧（Left），Z轴指向上方（Up）。

不同硬件平台可能会在底座上选择不同的附着点，但需确保坐标系方向的一致性，以便于后续的转换和算法应用。

2.2 odom 坐标系

odom 坐标系是一个相对于世界固定的局部参考框架（Local Reference Frame），具有以下特点：

连续性（Continuity）：在 odom 坐标系中，机器人的位姿（Pose，包括位置 Position 和姿态 Orientation）是连续变化的，不会出现突变。这保证了位姿估计的平滑性，有利于运动控制和路径规划。
漂移特性（Drift Characteristics）：由于依赖里程计（如轮式里程计 Wheel Odometry、视觉里程计 Visual Odometry 或惯性测量单元 Inertial Measurement Unit），odom 坐标系的位姿会随着时间积累漂移，且漂移量没有上限。因此，odom 不适合作为长期的全局参考。
短期精确（Short-term Accuracy）：尽管存在漂移，odom 在短期内仍能提供较为精确的位置估计，适用于局部导航和控制任务。

通常，odom 坐标系通过里程计数据实时更新，提供机器人的即时运动信息。

2.3 map 坐标系

map 坐标系是一个长期稳定的全局参考框架（Global Reference Frame），其主要特性包括：

世界固定（World-fixed）：map 坐标系的原点和方向在全局范围内保持相对稳定，不随时间变化。
无显著漂移（No Significant Drift）：通过持续的定位算法（如同步定位与地图构建 SLAM 或基于传感器的定位 Localization），map 坐标系中的位姿估计基本消除了漂移，确保长期稳定性。
非连续性（Non-continuity）：由于定位算法可能在接收到新的传感器信息时进行大规模的优化，map 坐标系中的位姿可能会发生离散跳跃（Discrete Jumps）。

map 坐标系适合作为长期的全局参考，支持跨越长时间和大范围的导航任务，但由于其非连续性，不适合用于实时的本地感知和控制。

2.4 earth 坐标系

earth 坐标系基于地心地固坐标系（Earth-Centered, Earth-Fixed, ECEF），其特点如下：

全球参考（Global Reference）：earth 坐标系提供了一个全球一致的参考框架，适用于多机器人系统中不同地图的协同工作。
多地图交互（Multi-map Interaction）：在需要多个地图同时存在的应用中，earth 坐标系充当不同地图之间的统一参考点，确保各机器人之间的位置关系的一致性。
可选性（Optionality）：对于单一地图应用，earth 坐标系通常不需要存在；仅在多地图或需要全球定位的场景中，earth 坐标系才显得必要。

3. 地图坐标系惯例（Map Frame Conventions）

地图坐标系的定义需遵循一定的惯例，以确保不同系统和用户之间的一致性和兼容性。

3.1 基于全球参考的地图坐标系定义（Map Frames Referenced Globally）

在基于全球参考（如地理坐标系）的情况下，地图坐标系的定义应遵循以下惯例：

轴向对齐（Axis Alignment）：
- X轴（X-axis）：指向东（East）。
- Y轴（Y-axis）：指向北（North）。
- Z轴（Z-axis）：指向上（Up）。
高度基准（Height Reference）：若无其他参考，Z轴的零点应与 WGS84 椭球面（WGS84 Ellipsoid）的高度相一致。

这些惯例确保地图坐标系与地理方向的一致性，便于与全球定位系统（GPS）等外部参考源的集成。

3.2 结构化环境中的地图坐标系惯例（Map Frames in Structured Environments）

在结构化环境（如办公楼、工厂车间）中，地图坐标系的定义可以根据环境特征进行优化：

环境对齐（Environment Alignment）：将地图坐标系与已知的环境布局对齐，例如建筑物的轴线（Building Axes）。
地面对齐（Ground Alignment）：在室内环境中，通常将地图坐标系的 Z轴对齐到地面，确保一致的高度参考。
多层协调（Multi-floor Coordination）：对于多层建筑，可为每一层定义独立的地图坐标系，以简化导航和任务分配。

在结构化环境中，尽管可以进行上述优化，但若存在歧义或环境信息不足，仍应退回使用基于全球参考的惯例。

3.3 应用特定的地图坐标系定义（Application-Specific Map Frames）

某些应用场景可能需要基于特定的参考位置定义地图坐标系。例如：

海平面高度（Mean Sea Level, MSL）：地图坐标系的 Z轴可以表示海平面以上的高度（如采用 EGM1996 大地水准面 [4]）。
初始位置参考（Initial Position Reference）：若机器人在启动时未连接外部参考设备（如 GPS、罗盘或高度计），但具备加速度计（Accelerometer），可将地图初始化为当前所在位置，Z轴指向上方。

关键在于清晰记录参考位置，以避免用户混淆（Ambiguity）。

4. 坐标系之间的关系（Relationship Between Frames）

坐标系之间的关系通常采用树状结构（Tree Structure），每个坐标系仅有一个父坐标系，且可以有多个子坐标系。以下详细描述各坐标系之间的连接关系及其逻辑。

4.1 坐标系树状结构（Coordinate Frame Tree Structure）

在典型的移动机器人系统中，各坐标系的层次关系如下：

earth（地心地固坐标系）
  └── map（地图坐标系）
        └── odom（里程计坐标系）
              └── base_link（基座链接坐标系）

map → odom → base_link：map 是 odom 的父坐标系，odom 是 base_link 的父坐标系。
earth → map：earth 是 map 的父坐标系。

尽管直觉上可能认为 map 和 odom 应该直接连接到 base_link，但由于每个坐标系只能有一个父坐标系，因此采用上述层次结构。

4.2 多机器人TF图示例（Multi-Robot TF Graph Example）

在多机器人系统中，若每个机器人使用独立的地图坐标系，且共享一个地球坐标系，则坐标系关系如下：

earth（地心地固坐标系）
  ├── map_1（地图坐标系1）
  │     └── odom_1（里程计坐标系1）
  │           └── base_link1（基座链接坐标系1）
  └── map_2（地图坐标系2）
        └── odom_2（里程计坐标系2）
              └── base_link2（基座链接坐标系2）

多个map（Multiple maps）：每个机器人拥有独立的 map 坐标系（map_1、map_2），避免了坐标系之间的冲突。
共享earth（Shared earth frame）：所有机器人的 map 坐标系均基于同一个 earth 坐标系，确保全球一致性。
标准化frame_ids（Standardized Frame IDs）：为便于重用，建议各机器人使用标准化的 frame_ids，并通过脚本在数据转发时进行重命名以区分不同机器人的坐标系。

5. 额外的中间坐标系（Extra Intermediate Frames）

在某些特定应用中，可能需要引入额外的中间坐标系以支持特定功能或优化性能。这些中间坐标系应在不破坏基础坐标系树状结构的前提下进行添加。

5.1 压力高度坐标系示例（Pressure Altitude Frame Example）

在飞行器等应用中，基于气压的高度估算（Pressure Altitude）是一种常用的高度参考方法。其特点和应用包括：

单轴漂移（Single-axis Drift）：压力高度基于气压测量，仅在垂直方向上可能产生漂移。
高精度测量（High Precision Measurement）：利用气压高度计（Barometric Altimeter）可实现精确的垂直位姿估算。
插入坐标系（Inserted Frame）：可在惯性一致的 odom 坐标系与 map 坐标系之间插入 pressure_altitude 坐标系，用于独立管理垂直位姿。
估算器需求（Estimator Requirement）：需要额外的估算模块来计算 pressure_altitude 相对于 map 坐标系的偏移量。

引入 pressure_altitude 坐标系可增强系统对垂直位姿的管理能力，且不影响基础坐标系的结构。

6. 坐标系的权威性（Frame Authorities）

各坐标系之间的转换需由特定的组件或模块负责计算和广播，以确保数据的一致性和准确性。

6.1 odom 到 base_link 的转换

计算与广播（Computation and Broadcasting）：由其中一个里程计源（如轮式里程计、视觉里程计或惯性测量单元）负责计算并广播 odom 到 base_link 的转换。
实时更新（Real-time Updates）：该转换基于实时的里程计数据，反映机器人当前的运动状态。

6.2 map 到 odom 的转换

定位组件职责（Localization Component Responsibility）：由定位模块（如 SLAM 或定位算法）负责计算 map 到 odom 的转换。
转换逻辑（Transformation Logic）：定位组件接收 odom 到 base_link 的转换信息，结合传感器观测数据，计算出 map 到 odom 的转换，进而保证 map 坐标系中位姿的稳定性。
广播方式（Broadcasting Method）：定位组件不直接广播 map 到 base_link 的转换，而是通过 map 到 odom 的转换间接维护两者之间的关系。

6.3 earth 到 map 的转换

静态发布（Static Publishing）：若 map 坐标系基于全局参考（如 GPS），则 earth 到 map 的转换可通过静态变换发布器（Static Transform Publisher）进行发布。
动态计算（Dynamic Computation）：若 map 坐标系不具备全局参考，需基于当前的全球位置估计和 map 坐标系中的位姿估计，动态计算 earth 到 map 的转换。
启动时处理（Startup Handling）：若启动时 map 坐标系的绝对位置未知，可保持其与 earth 的分离，待全球位置估计足够准确后再进行关联。

7. 地图间的转换（Transitions Between Maps）

当机器人移动超过单一地图的有效范围时，可能需要在不同地图之间进行转换。这在户外长距离移动或室内跨越多个建筑/楼层时尤为重要。

7.1 户外环境中的地图转换（Map Transitions in Outdoor Environments）

地球曲率影响（Earth Curvature Effects）：由于地球曲率的影响，长距离移动后，地图坐标系作为欧几里得近似的有效性下降。此时需通过重新定位（Relocalization）或地图拼接（Map Stitching）技术，更新或转换地图坐标系。

7.2 室内环境中的地图转换（Map Transitions in Indoor Environments）

跨越建筑或楼层（Crossing Buildings or Floors）：在跨越不同建筑物或楼层时，可为每个区域或楼层定义独立的地图坐标系，利用定位框架的权威性重新挂靠 odom 坐标系，实现坐标系间的平滑过渡。

7.3 实现机制（Implementation Mechanism）

定位框架的权威性（Localization Frame Authority）：定位模块负责在地图转换时重新定义 odom 的父坐标系，确保 odom 坐标系的连续性不受影响。
自动处理（Automatic Handling）：通过计算 map 到 odom 的转换，系统可在地图选择变化时自动处理坐标系的转换，保持位姿估计的连续性。

8. odom 坐标系的一致性（Consistency of the Odom Frame）

在坐标系转换和长距离移动过程中，确保 odom 坐标系的一致性至关重要。

8.1 数据保留策略（Data Retention Policies）

漂移管理（Drift Management）：由于 odom 坐标系会随时间漂移，需设定数据保留策略（Data Retention Policies），以避免旧数据因位姿误差过大而失效。
里程计质量影响（Impact of Odometry Quality）：不同类型的里程计具有不同的漂移速率。例如：
- 高精度轮式里程计（High-precision Wheel Odometry）：漂移速率低，可保留较长时间或较大距离的数据。
- 滑移式机器人（Skid-steer Robots）：漂移速率高，应更频繁地丢弃旧数据，避免误差积累。
外部干扰因素（External Disturbances）：如机器人被外力移动或环境发生变化（如电梯内的机器人），需调整数据保留策略，确保 odom 坐标系的一致性。

8.2 浮点数精度限制及解决方案（Floating-point Precision Limitations and Solutions）

精度问题（Precision Issues）：当机器人移动距离过大，odom 坐标系的原点与机器人位置的距离接近浮点数的最大精度范围（约83公里以内的厘米级精度）时，可能导致精度下降。
解决方案（Solutions）：
- 坐标系重置（Frame Origin Reset）：系统性地重置 odom 坐标系的原点，以保持原点与机器人之间的距离在精度范围内。
- 额外坐标系（Additional Frames）：引入新的坐标系用于持久化障碍物数据（Obstacle Data），避免过大的坐标值影响精度。
- 高精度表示（Higher Precision Representations）：采用更高精度的数据类型（如64位浮点数）存储位姿和点云数据，提升整体系统的精度容忍度。

目前，针对浮点数精度限制尚无统一标准，系统需根据具体应用场景和精度需求，选择合适的解决方案。

9. 结论（Conclusion）

准确和一致的坐标系管理是移动机器人系统中不可或缺的一部分。通过合理定义和管理 base_link、odom、map、earth 等基础坐标系，并遵循相关惯例和标准，可以确保机器人在复杂环境中的稳定定位与导航能力。在多机器人系统和长距离移动场景下，坐标系的合理设计与转换策略尤为重要，需结合具体应用需求进行优化和调整。