R机器人实验室ROBOTICS ATLAS
模块 / M22 / 路径与轨迹:几何路径、时间律与参数化
v2 课件目录完整实验台 ↗
① G1 实验台 · D01兴趣引入 · 复用原站点演示 复用本站 D01 课时真实 G1 人形实验台;先看整机,再回到本章的人形问题
独立打开 ↗
② 时间律与速度剖面概念演示 · 与本模块同步 拖参数,看图形与读数

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

本模块核心关系 · 教学示意q(t) = q(s(t));q̈ = q″(s)ṡ² + q′(s)s̈
看什么:看 v(t) / a(t) / j(t) 三条剖面;把 T 压短,峰值按 1/T、1/T²、1/T³ 放大,读出需要的放慢倍数 λ。

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

路径与轨迹:几何路径、时间律与参数化

能说出路径与轨迹的区别,写出链式求导关系,并把「任务 → 路径 → 时间律 → 控制」三层接口画出来。

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

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

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

摆腿相足端沿一条空间曲线从后往前:这条曲线是路径,走多快由时间律决定——同一条摆腿路径可以快走也可以慢走,但关节力矩完全不同。

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

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

同一条几何路径配上两条不同的时间律,机器人走过的点一样吗?速度、加速度与关节力矩呢?

为什么独立成章:旧版把「轨迹」直接等同于三次多项式,学生分不清几何对象与运动对象;本章先把两个对象分开,后面所有插值、速度剖面与优化才有共同语言。

知识层级L5 · 路径与轨迹
课程性质本科必修 · 3 学时
学习结果能说出路径与轨迹的区别,写出链式求导关系,并把「任务 → 路径 → 时间律 → 控制」三层接口画出来。
概念台模型timelaw

概念辨析 5 组

路径 path构型空间中的几何点集 q(s),s ∈ [0,1] 是无量纲路径参数;与时间无关,不含速度、不含驱动信息。
轨迹 trajectoryq(t) = q(s(t)):在同一条几何路径上附加一条时间律 s(t);同一路径对应无穷多条轨迹。
时间律 time law单调不减的 s(t),决定「何时走到路径的哪一点」;ṡ 是路径速率,不是某个关节的速度。
链式求导ḋq = q′(s)·ṡ,q̈ = q″(s)·ṡ² + q′(s)·s̈;加速度并不沿路径切线,这一项正是后面力矩约束的来源。
三层接口路径规划层给几何、轨迹规划层给时间律、控制层给关节力矩;三层各自优化的对象不同,不能互相替代。

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

式 (M22.1)q(t) = q(s(t)), 0 ≤ s ≤ 1, ṡ ≥ 0

路径与轨迹的定义式;ṡ = 0 表示在路径上停住,不允许倒退。

式 (M22.2)ḋq = q′(s)ṡ ; q̈ = q″(s)ṡ² + q′(s)s̈

把几何导数 q′、q″ 与时间导数 ṡ、s̈ 分开,是 TOPP 的起点。

式 (M22.3)T = ∫₀¹ ds / ṡ(s)

遍历整条路径的总时间;最短时间问题就是让 ṡ(s) 在每一点尽量大。

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

方法与步骤

  1. 先给几何路径,再给时间律;不要一上来就写 q(t) 的多项式。
  2. 把「平滑」拆成两件不同的事:路径几何连续(C¹/C²)与运动学连续(v / a / jerk 受限)。
  3. 用弧长参数化统一不同速度下的同一条路径。
  4. 检查 ṡ ≥ 0;在路径曲率大的地方,ṡ 必须下降,否则违反加速度或力矩约束。

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

焊接直线焊缝:几何路径是一条空间直线且保持不变,只改时间律就能改变焊接速度与热输入;路径相同、轨迹不同,机器人走过的点一样,但速度、加速度与驱动力矩完全不同。

路径是几何对象,轨迹是路径加时间律;q̈ 里的 q″(s)ṡ² 项说明加速度并不沿路径切线,这正是后面力矩约束与轨迹优化的起点。

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

② 概念台怎么读

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

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

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

概念台边界:② 只画同一条五次多项式路径在不同 T 下的速度 / 加速度 / jerk 剖面,不仿真具体机械臂的连杆几何。

章节依据 可逐条追溯

主干 / 主补充:

  • BIAGIOTTI Ch1 / Ch8–9
  • CRAIG §7.1 引子
  • CHOSET Ch3 构型空间

其他参照:SICILIANO §4.1 轨迹规划引论;LAVALLE Ch4 C-space

先修链 显式 DAG

M11正运动学:连杆变换连乘(L2)
M13逆运动学:解存在性、子空间与解析解(L2)

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

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

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

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

自测 · 掌握证据

题目:同一条路径的两条不同时间律,位置点集是否相同?速度、加速度呢? 为什么 q̈ 里会有 q″(s)ṡ² 这一项?它沿路径的哪个方向?

提示:从 ② 里找证据

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

出处 · 本模块内容来源

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

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