R机器人实验室ROBOTICS ATLAS
课时 / B06 / 位姿逆运动学
全部课时完整实验台 ↗
① 位姿逆运动学 · G1兴趣引入 · 原站点演示 场景内可切视角;下方选参考系、放预测点并看读数
独立打开 ↗
② 位姿逆解:位置对了,朝向还要对概念演示 · 与本课时同步 拖参数,看图形与读数

误差向量既有位置分量,也有姿态分量。

本课时核心关系 · 讲义原式e = [e_p;ℓ Log(R_target R_currentᵀ)]
看什么:保持目标点不动,只改变第二个关节角:末端可能仍在附近,但工具轴方向已经偏了。位置误差小不等于位姿误差小。

B06 · 位姿逆运动学 · 单页课件

手到了,掌心也能朝对方向吗?

本课时的问题是:手到了,掌心也能朝对方向吗?。右栏内容主体取自本站 B06 课时讲义,按讲义原有顺序完整展开。左边两块演示分工:① 站点原有的 G1 三维实验台负责把问题提出来;② 「位姿逆解:位置对了,朝向还要对」把本课时的核心关系画成可拖、可读数的交互图。

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

怎么用左边两个演示:先在 ① 里动手试一次,把问题提出来;再到 ② 里拖参数,看图形与读数怎样随核心关系变化。保持目标点不动,只改变第二个关节角:末端可能仍在附近,但工具轴方向已经偏了。位置误差小不等于位姿误差小。 右栏的「在 ② 里看」按钮会把概念台切到对应预设。

本版怎么操作 Modern Robotics §6.2 · 位姿误差

  1. 摆放苹果并选择接近方向
  2. 比较位置、轴向与完整位姿约束
  3. 旋转目标掌面,再求解和应用

抓取需要决定从哪个方向接近,而非仅把手中心放到苹果中心。本页把手部目标放在苹果外侧7.5 cm,工具x轴定义接近方向;不同任务约束会消耗不同的运动自由度。

讲义原式 · B06e = [e_p;ℓ Log(R_target R_currentᵀ)]

实验范围:没有手指闭合与抓握接触。默认目标通过真实FK构造,可在高级选项重新生成可达目标。

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

同一个苹果,还可以规定怎样接近

给苹果旁增加目标坐标架:位置决定手到哪里,姿态决定掌心如何靠近。比较“只管位置”“只管工具 x 轴接近方向”和“完整位姿”三种任务。第三种要求更强,常常需要更多迭代,甚至在同一位置找不到满足朝向的合法关节解。

姿态误差属于旋转群

不能直接用三个欧拉角之差代表空间转动。先计算目标相对于当前的旋转 R_des Rᵀ,再取对数得到轴角向量 e_R。本页使用世界系误差,与世界系角速度雅可比配套。对近 180° 的旋转,四元数分支采用最短旋转;正好 180° 时轴符号不唯一,但旋转本身确定。

讲义原式 · B06e_R = Log(R_des R(q)ᵀ)∨ e = [p_des−p(q); ℓ e_R], J_s = [J_v; ℓ J_ω] ℓ = 0.25 m/rad

为什么引入特征长度

位置误差 1 cm 和姿态误差 0.04 rad,在 ℓ=0.25 m/rad 的缩放下都对应 0.01 m。这个数调节数值优化中的相对权重,不会把米变成角度。验收时仍分别检查位置 <1 mm、姿态 <0.5°。改变权重可能改变收敛路线,不能替代明确的双重误差门限。

接近方向少约束了什么

只指定工具 x 轴,仍允许绕该轴转动,因此任务只有两个独立方向约束。接近轴误差使用两单位向量之间的最短转动,不能用反向时也为零的简单叉乘充当全部误差。先使用“由合法关节生成目标”建立可复现基准,再挑战自由设置的目标姿态。

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

出处 · 本课时内容来源

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

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