R机器人实验室ROBOTICS ATLAS
模块 / M23 / 关节空间插值:多项式、边界条件与连续性阶次
v2 课件目录完整实验台 ↗
① G1 实验台 · D02兴趣引入 · 复用原站点演示 复用本站 D02 课时真实 G1 人形实验台;先看整机,再回到本章的人形问题
独立打开 ↗
② 时间律与速度剖面概念演示 · 与本模块同步 拖参数,看图形与读数

同一条几何路径,换一条时间律,速度与加速度剖面就完全不同。

本模块核心关系 · 教学示意q(τ) = q₀ + Δ(10τ³ − 15τ⁴ + 6τ⁵) ; q̈_max ∝ Δ/T²
看什么:看 v(t) / a(t) / j(t) 三条剖面;把 T 压短,峰值按 1/T、1/T²、1/T³ 放大,读出需要的放慢倍数 λ。

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

关节空间插值:多项式、边界条件与连续性阶次

能按给定边界条件数目选择多项式阶次,解出系数,并判断过冲、峰值速度与多轴同步问题。

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

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

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

起脚与落脚要求位置、速度、加速度都连续;条件数决定该用三次、五次还是七次多项式。

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

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

给定起止位置、速度、加速度共六个条件,多项式阶次为什么必须是五次?

为什么独立成章:把「背三次 / 五次公式」提升为「按连续性需求定阶次」,并让学生看到提高阶次的代价。

知识层级L5 · 路径与轨迹
课程性质本科必修 · 3 学时
学习结果能按给定边界条件数目选择多项式阶次,解出系数,并判断过冲、峰值速度与多轴同步问题。
概念台模型timelaw

概念辨析 5 组

归一化时间τ = t/T ∈ [0,1];把时长 T 从插值形状里分离出来,便于之后单独做时间缩放。
边界条件与阶次三次多项式 4 个系数对应起止位置 + 速度;五次 6 个系数再加起止加速度;七次 8 个再加起止 jerk。
连续性阶次C⁰ 位置连续、C¹ 速度连续、C² 加速度连续、C³ jerk 连续;加速度跳变会激起结构振动。
系数求解把边界条件写成关于 a₀…aₙ 的线性方程组(Vandermonde 型),解出闭式系数。
阶次的代价阶次越高越容易出现过冲与振荡;单轴最优不等于多轴同步,各轴位移不同却要共用同一个 T。

核心关系式 Biagiotti Ch2–3 / Ch5;Craig §7.2–7.3

式 (M23.1)q(τ) = Σₖ₌₀ⁿ aₖ τᵏ

n 由独立边界条件数减 1 决定,不是随便选的。

式 (M23.2)起止 v = a = 0 时,Δ = q₁ − q₀:q(τ) = q₀ + Δ(10τ³ − 15τ⁴ + 6τ⁵)

五次多项式的最小 jerk 形状;速度、加速度在两端都为零。

式 (M23.3)max|ḋq| ≈ 1.875 Δ/T ; max|q̈| ≈ 5.774 Δ/T²

把峰值直接与 T 挂钩,说明「缩短 T」会按平方放大加速度需求。

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

方法与步骤

  1. 数边界条件 → 定阶次 → 解线性方程 → 复核 q̇、q̈ 峰值是否超限。
  2. 多轴按最慢轴统一 T,再逐轴检查 v / a 限。
  3. 需要 C³ 连续时才用七次;否则优先五次,避免不必要的过冲。

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

6 轴搬运:若每个关节各自取「最短 T」,六个轴会在不同时刻到位,末端走出一条与设计不同的路径;必须统一 T,再复核每个关节的峰值加速度。

阶次由独立边界条件数决定;五次多项式在起止 v = a = 0 时化为 10τ³−15τ⁴+6τ⁵,峰值加速度按 1/T² 增长,多轴必须共用同一个 T。

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

② 概念台怎么读

时间律与速度剖面。同一条几何路径,换一条时间律,速度与加速度剖面就完全不同。

看什么:看 v(t) / a(t) / j(t) 三条剖面;把 T 压短,峰值按 1/T、1/T²、1/T³ 放大,读出需要的放慢倍数 λ。

滑块分别改变 时长 T、加速度上限、jerk 上限;读数板列出中间量与判定。预设「基准 T=1.6s」等对应最容易出错的几组条件。

概念台边界:② 用五次多项式的归一化导数形状演示 T 对峰值的影响,不求解具体 6R 臂的系数矩阵。

章节依据 可逐条追溯

主干 / 主补充:

  • CRAIG §7.2–7.3
  • BIAGIOTTI Ch2.1 多项式轨迹

其他参照:CORKE Ch3 时变位姿;SICILIANO §4.2 关节空间轨迹

先修链 显式 DAG

M22路径与轨迹:几何路径、时间律与参数化(L5)

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

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

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

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

自测 · 掌握证据

题目:给定起止位置、速度、加速度共 6 个条件,为什么必须用五次而不是三次? T 减半时峰值加速度变为几倍?为什么多轴不能直接各取最短时间?

提示:从 ② 里找证据

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

出处 · 本模块内容来源

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

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