A04 · 坐标链 · 单页课件
沿着身体找苹果,哪一步坐标换错了?
本课时的问题是:沿着身体找苹果,哪一步坐标换错了?。右栏内容主体取自本站 A04 课时讲义,按讲义原有顺序完整展开。左边两块演示分工:① 站点原有的 G1 三维实验台负责把问题提出来;② 「坐标链:下标消去律」把本课时的核心关系画成可拖、可读数的交互图。
内容主体:本站 A04 课时讲义(依据公开教程与本地课件重新组织) | 配套:① 原站点 G1 演示 + ② 本课时概念交互台
本版怎么操作 Modern Robotics §3.2.1.2 · Eq (3.22), p.71
- 从左手或骨盆开始沿链前进
- 展开完整变换链
- 故意漏一段或交换顺序,观察错误落点
矩阵下标说明输入和输出参考系。相邻下标能够衔接时,才对应一条有物理意义的坐标链。相乘顺序错了,计算仍可能得到数,却不能把同一个苹果放回原处。
实验范围:工具偏置固定为腕局部x方向0.14 m,本页不修改真实模型几何。
从地面到手心,中间经过哪些坐标系?
机器人想让左手靠近苹果,需要把世界、骨盆、躯干、肩、腕、工具之间的关系接起来。从左手或骨盆开始,点击“沿链前进一步”,观察累计矩阵如何把当前参考系的苹果坐标换到起始参考系。把结果映回世界,应与真实苹果重合。
图中的 W、B、T、S、K、H 分别表示世界、骨盆、躯干、肩部、腕部和教学工具坐标系。为便于读图,肩到腕之间的多个关节被合并成一段相对变换;这段矩阵仍由全部实际关节状态计算,不意味着手臂只有一个关节。
下标相接,坐标才能接力
最右边先把 H 中的坐标转到 K,之后逐级转到 W。相邻矩阵中间的坐标系必须一致。链条从 W 向 H 展示的是参考系层级,矩阵作用于列向量时的计算顺序则从右向左;两者不能混为一谈。
每段相对变换都从模型的世界位姿取得:T_AB = T_WA⁻¹ T_WB。按链连乘后应恢复目标坐标系的世界位姿。误差表使用 MuJoCo 的目标位姿作为对照,不用同一份连乘结果自己证明自己。
让一个错误变得可见
本版默认链从手H沿身体走到世界W。“漏最后一段”忽略的是B与W之间的变换,因此会错误地把骨盆坐标当成世界坐标。具体误差取决于被遗漏的变换,不能笼统写成固定的0.14米。工具偏置遗漏的专门对照位于A07。
再试“交换末两段”。即使每个矩阵本身都正确,连接顺序不对也会破坏坐标含义。某些初始姿态下两个特定变换恰好可交换,数值误差可能为零;下标检查仍然必要。可以转动腰部,或选择不同的起点与终点,观察错误何时显现。
从左手看右手,不必绕远路猜
可进一步在纸上连接左手与右手的坐标链,并对反向经过的变换取逆。两只手共同受到一个腰部刚体旋转时,相对位姿可以不变:世界中的运动未必改变彼此关系。本页直接操作的是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 模型来源 ↗ ↗
本页由 A01 单页课件模式批量生成;32 个课时各自独立存放,旧版文件未覆盖。① 需经本地 HTTP 服务加载 ES module 与模型;② 为页内 SVG,离线可用。