R机器人实验室ROBOTICS ATLAS
课时 / A04 / 坐标链
全部课时完整实验台 ↗
① 坐标链 · G1兴趣引入 · 原站点演示 场景内可切视角;下方选参考系、放预测点并看读数
独立打开 ↗
② 坐标链:下标消去律概念演示 · 与本课时同步 拖参数,看图形与读数

从世界 W 一路写到手 H,中间的系名会成对消掉。

本课时核心关系 · 讲义原式T_AB T_BC = T_AC
看什么:把 O_b 当成链路中间的一个系;观察每次换系时 p 的读数如何被 R 和 t 改写。T_AB T_BC = T_AC 的「消去」在这里就是两次读数的合成。

A04 · 坐标链 · 单页课件

沿着身体找苹果,哪一步坐标换错了?

本课时的问题是:沿着身体找苹果,哪一步坐标换错了?。右栏内容主体取自本站 A04 课时讲义,按讲义原有顺序完整展开。左边两块演示分工:① 站点原有的 G1 三维实验台负责把问题提出来;② 「坐标链:下标消去律」把本课时的核心关系画成可拖、可读数的交互图。

内容主体:本站 A04 课时讲义(依据公开教程与本地课件重新组织) | 配套:① 原站点 G1 演示 + ② 本课时概念交互台

怎么用左边两个演示:先在 ① 里动手试一次,把问题提出来;再到 ② 里拖参数,看图形与读数怎样随核心关系变化。把 O_b 当成链路中间的一个系;观察每次换系时 p 的读数如何被 R 和 t 改写。T_AB T_BC = T_AC 的「消去」在这里就是两次读数的合成。 右栏的「在 ② 里看」按钮会把概念台切到对应预设。

本版怎么操作 Modern Robotics §3.2.1.2 · Eq (3.22), p.71

  1. 从左手或骨盆开始沿链前进
  2. 展开完整变换链
  3. 故意漏一段或交换顺序,观察错误落点

矩阵下标说明输入和输出参考系。相邻下标能够衔接时,才对应一条有物理意义的坐标链。相乘顺序错了,计算仍可能得到数,却不能把同一个苹果放回原处。

讲义原式 · A04T_AB T_BC = T_AC

实验范围:工具偏置固定为腕局部x方向0.14 m,本页不修改真实模型几何。

↔ 概念演示把讲义里的关系放到 ② 里亲手拖一遍,读数会随参数实时变化。

从地面到手心,中间经过哪些坐标系?

机器人想让左手靠近苹果,需要把世界、骨盆、躯干、肩、腕、工具之间的关系接起来。从左手或骨盆开始,点击“沿链前进一步”,观察累计矩阵如何把当前参考系的苹果坐标换到起始参考系。把结果映回世界,应与真实苹果重合。

图中的 W、B、T、S、K、H 分别表示世界、骨盆、躯干、肩部、腕部和教学工具坐标系。为便于读图,肩到腕之间的多个关节被合并成一段相对变换;这段矩阵仍由全部实际关节状态计算,不意味着手臂只有一个关节。

下标相接,坐标才能接力

讲义原式 · A04T_WH = T_WB T_BT T_TS T_SK T_KH p_W = T_WH p_H(这里的点使用齐次坐标)

最右边先把 H 中的坐标转到 K,之后逐级转到 W。相邻矩阵中间的坐标系必须一致。链条从 W 向 H 展示的是参考系层级,矩阵作用于列向量时的计算顺序则从右向左;两者不能混为一谈。

每段相对变换都从模型的世界位姿取得:T_AB = T_WA⁻¹ T_WB。按链连乘后应恢复目标坐标系的世界位姿。误差表使用 MuJoCo 的目标位姿作为对照,不用同一份连乘结果自己证明自己。

让一个错误变得可见

本版默认链从手H沿身体走到世界W。“漏最后一段”忽略的是B与W之间的变换,因此会错误地把骨盆坐标当成世界坐标。具体误差取决于被遗漏的变换,不能笼统写成固定的0.14米。工具偏置遗漏的专门对照位于A07。

再试“交换末两段”。即使每个矩阵本身都正确,连接顺序不对也会破坏坐标含义。某些初始姿态下两个特定变换恰好可交换,数值误差可能为零;下标检查仍然必要。可以转动腰部,或选择不同的起点与终点,观察错误何时显现。

从左手看右手,不必绕远路猜

讲义原式 · A04T_HL,HR = T_W,HL⁻¹ T_W,HR

可进一步在纸上连接左手与右手的坐标链,并对反向经过的变换取逆。两只手共同受到一个腰部刚体旋转时,相对位姿可以不变:世界中的运动未必改变彼此关系。本页直接操作的是H或B到W的链。

坐标树与 DH 表是什么关系?

当前 G1 模型用 MJCF 刚体树和局部变换描述,不是一张已经建立好的 Craig DH 表。坐标链展示的是变换组合的一般规律。后续 DH 页面还必须独立选择连杆坐标系、声明标准或改进 DH 约定,并验证所得变换与模型一致,不能直接把模型中的任意 body 坐标当作 DH 坐标。

换一个工具,再检查结果

调整教学工具偏置,预测遗漏最后一段时的位置误差。迁移题设偏置 0.20 米,问“只算到腕”会差多少米。若把偏置改成零,位置误差会消失,但这不证明任意工具都可以省掉这段变换。回到完整链,检查位置与姿态误差同时接近零。

↔ 概念演示把讲义里的关系放到 ② 里亲手拖一遍,读数会随参数实时变化。
检查点 · 讲义原题

T_AB 与 T_BC 按此顺序相乘,结果把哪个系映到哪个系?

查看判断依据

中间的B衔接,结果为T_AC。

出处 · 本课时内容来源

  • 内容主体 本站 a04.html 课时讲义,按原有章节顺序完整展开;讲义依据公开教程与本地数学基础课件重新组织,非教材章节扫描件。
  • ① 兴趣引入 站点原有 G1 三维实验台,通过 ?embed=topic 嵌入模式复用,未改写原页面代码。
  • ② 概念演示 本页新增的参数化 SVG 交互台,用于直观呈现本课时核心关系;教学示意模型,不是真实机器人仿真。
  • 延伸阅读 Modern Robotics · 齐次变换 ↗ ↗
  • 延伸阅读 MuJoCo · 模型与计算 ↗ ↗
  • 延伸阅读 G1 · Menagerie 模型来源 ↗ ↗
使用边界:Modern Robotics 预印本扉页声明 "personal use only and not for further distribution";本套课件只引用公开教程链接与本站自有讲义,不复制教材章节正文、不镜像 PDF。概念台的数值为教学示意,用于观察关系,不作为工程计算结果。

本页由 A01 单页课件模式批量生成;32 个课时各自独立存放,旧版文件未覆盖。① 需经本地 HTTP 服务加载 ES module 与模型;② 为页内 SVG,离线可用。