R机器人实验室ROBOTICS ATLAS
模块 / M46 / 笛卡尔空间路径与姿态插值
v2 课件目录完整实验台 ↗
① G1 实验台 · D04兴趣引入 · 复用原站点演示 复用本站 D04 课时真实 G1 人形实验台;先看整机,再回到本章的人形问题
独立打开 ↗
② 两次旋转,换个顺序概念演示 · 与本模块同步 拖参数,看图形与读数

同样两个角度,换个乘法次序,姿态并不一样。

本模块核心关系 · 教学示意Q(u) = [sin((1−u)Ω)/sinΩ]Q₀ + [sin(uΩ)/sinΩ]Q₁
看什么:比较两种顺序得到的工具轴方向;相对转角不为 0 就说明旋转矩阵乘法不交换。

模块 M46 · L5 路径与轨迹 · 必修 · 单页课件

笛卡尔空间路径与姿态插值

会写出直线 / 圆弧路径的参数式,用单位四元数 SLERP 做最短路径姿态插值,并说明逐点逆解的计算代价与奇异风险。

内容主体:本科机器人学课程体系 v2(Craig 骨架 · 路径轨迹与控制扩展)中的章节正文;以 G1 人形机器人为贯穿案例 | 配套:① 原站点演示 + ② 本模块概念交互台

怎么用左边两个演示:先在 ① 的真实 G1 人形平台上动手试一次,把本章的人形问题提出来;再到 ② 里拖参数,看图形与读数怎样随核心关系变化。① 是本站已有真实实验台,用作兴趣 / 问题引入,不是本模块专属仿真;② 才与本模块核心关系直接对应。右栏的「在 ② 里看」按钮会把概念台切到对应预设。

人形机器人 · 本章引入 G1 案例

手伸向杯子时,位置走直线、姿态走四元数大圆;对欧拉角做线性插值会让手腕中途翻转。

① 的真实 G1 三维实验台是这一章的兴趣引入:先在左栏看整机的姿态与读数,把「这台人形机器人为什么需要本章」提出来;再到 ② 把核心关系亲手拖一遍。

本节要解决的问题 章节定位

任务空间走一条直线,各关节角是否也随时间线性变化?姿态为什么不能对欧拉角线性插值?

为什么独立成章:任务空间的几何路径与关节空间插值并不等价,姿态插值更不能对欧拉角做线性插值;这一章处理「沿什么形状走、朝什么方向」。

知识层级L5 · 路径与轨迹
课程性质本科必修 · 3 学时
学习结果会写出直线 / 圆弧路径的参数式,用单位四元数 SLERP 做最短路径姿态插值,并说明逐点逆解的计算代价与奇异风险。
概念台模型rotation

概念辨析 5 组

任务空间路径x(t) = x₀ + s(t)(x₁ − x₀) 为空间直线;圆弧与样条路径可同样用参数 s 描述。
两空间不等价任务空间走直线,各关节一般不是直线;需在轨迹层逐点求逆运动学,计算量随点数增长。
姿态插值陷阱欧拉角线性插值会出现万向节退化、非最短路径与角速度不均;RPY 同样不适合直接插值。
SLERP单位四元数球面线性插值:沿四维单位球面的大圆走,角速度恒定且路径最短。
位置 / 姿态同步位置用 s_p(t)、姿态用 s_R(t),两者共用一条时间律才能保持末端轨迹的时间一致性。

核心关系式 Modern Robotics §3.2.1

式 (M46.1)x(t) = x₀ + s(t)(x₁ − x₀)

任务空间直线路径,s(t) 仍是时间律。

式 (M46.2)Q(u) = [sin((1−u)Ω)/sinΩ] Q₀ + [sin(uΩ)/sinΩ] Q₁ , cosΩ = Q₀·Q₁

单位四元数 SLERP;全程只用三角函数,不引入矩阵指数(本科约束)。

式 (M46.3)τ = Jᵀ(q) F ; q̇ = J⁻¹(q) ẋ

任务空间速度要经 Jacobian 映射到关节空间,奇异附近会失效。

↔ 概念演示先把第一组条件放到 ② 里亲手拖一遍。

方法与步骤

  1. 位置与姿态分别写参数式,但共用时间律 s(t)。
  2. 姿态优先用四元数 SLERP,并对 Q 与 −Q 取同一物理姿态的短弧。
  3. 逐点逆解要预先检查奇异与关节限位;必要时退回关节空间插值。
  4. 在途经点处安排减速或混成,避免速度方向突变。

工程例子 把式子落到真实约束上

弧焊 / 涂胶:末端必须沿工件表面直线匀速移动,同时焊枪姿态沿曲面连续转动;若对欧拉角做线性插值,中途会出现姿态抖动甚至翻转。

任务空间路径要逐点逆解到关节空间,姿态必须走单位四元数的大圆(SLERP);全程只用三角函数,符合本科不引入矩阵指数的约束。

↔ 概念演示换一组预设,看关系在不同条件下怎样变化。

② 概念台怎么读

两次旋转,换个顺序。同样两个角度,换个乘法次序,姿态并不一样。

看什么:比较两种顺序得到的工具轴方向;相对转角不为 0 就说明旋转矩阵乘法不交换。

滑块分别改变 α、β、观察轴;读数板列出中间量与判定。预设「先 x 后 y · 90°」等对应最容易出错的几组条件。

概念台边界:② 复用旋转顺序实验台,用来直观看到「姿态参数不是线性量」;SLERP 公式在右栏给出。

章节依据 可逐条追溯

主干 / 主补充:

  • CRAIG §7.4–7.5 / App B
  • BIAGIOTTI Ch8 多维轨迹与几何路径 / App C 姿态表示

其他参照:CORKE Ch2 位置与姿态;SICILIANO §4.2.2 任务空间轨迹

先修链 显式 DAG

M22路径与轨迹:几何路径、时间律与参数化(L5)
M09其他姿态描述:欧拉角 / RPY / 四元数(L1)

先修关系写在 curriculum-craig-v2/curriculum.json 的 prereq 字段,50 个模块整体无环、可直接拓扑排序。

编写状态与使用边界 如实标注

页面形态:A01 单页两栏课件 右栏:章节讲义教学版(概念 / 公式 / 方法 / 例子) ① 真实 G1 演示:兴趣 / 问题引入 ② 概念交互台:与本模块核心关系对应 教材正文:未复制、未镜像

使用边界:商业教材只登记公开目录、算法事实与公式;① 是本站已有真实交互实验台,用作兴趣 / 问题引入,不是本模块专属仿真;② 是教学示意模型,数值用于观察关系,不作为工程计算结果。

自测 · 掌握证据

题目:为什么四元数 Q 与 −Q 表示同一姿态?插值时为什么要先判断点积符号? 任务空间直线路径下,各关节角是否也随时间线性变化?

提示:从 ② 里找证据

先在概念台里复现一组典型条件,再用核心关系式逐项核对读数;能说清「哪个量变了、哪个量没变、为什么」,才算达到本模块的掌握证据。

出处 · 本模块内容来源

  • 内容主体 curriculum-craig-v2/curriculum.json 与 01_课程体系大纲_路径轨迹与控制扩展.md 中的章节 M46;主干教材为 Craig《Introduction to Robotics》4/e。
  • ① 兴趣引入 站点原有 G1 三维实验台 d04.html,通过 ?embed=topic 嵌入模式复用,未改写原页面代码。
  • ② 概念演示 本页新增的参数化 SVG 交互台,用于直观呈现本模块核心关系;教学示意模型,不是真实机器人仿真。
  • 主干 / 主补充章节(可逐条追溯) CRAIG §7.4–7.5 / App B;BIAGIOTTI Ch8 多维轨迹与几何路径 / App C 姿态表示
  • 其他参照 CORKE Ch2 位置与姿态;SICILIANO §4.2.2 任务空间轨迹
使用边界:本页按 v2 大纲逐节展开概念辨析、核心关系式、方法步骤与工程例子,是章节讲义的教学版,不是教材正文的复制;商业教材只用公开目录、算法事实与公式。Craig / Biagiotti / Siciliano / Ogata 等为商业教材;MIT OCW 与作者公开预印本按各自许可引用。概念台数值用于观察关系,不作为工程计算结果。

本页按 A01 单页课件模式生成,承载 v2 体系重写 / 新增的扩展章节;17 份课件独立存放在全新目录,v1 体系、19 份缺口课件、32 份课时课件与 91 模块课件一份未动。① 需经本地 HTTP 服务加载 ES module 与模型;② 为页内 SVG,离线可用。