模块 M49 · L5 路径与轨迹 · 必修 · 单页课件
从几何路径到轨迹:时间律与控制接口
能列出轨迹层交给控制层的 q_d、q̇_d、q̈_d 与前馈量,说明可行性检查与在线时间重参数化。
内容主体:本科机器人学课程体系 v2(Craig 骨架 · 路径轨迹与控制扩展)中的章节正文;以 G1 人形机器人为贯穿案例 | 配套:① 原站点演示 + ② 本模块概念交互台
人形机器人 · 本章引入 G1 案例
轨迹层必须把 q_d、q̇_d、q̈_d 一起交给控制器;人靠近时常常只改时钟 s(t),几何路径与控制器都不用换。
① 的真实 G1 三维实验台是这一章的兴趣引入:先在左栏看整机的姿态与读数,把「这台人形机器人为什么需要本章」提出来;再到 ② 把核心关系亲手拖一遍。
本节要解决的问题 章节定位
控制层为什么需要 q̈_d 而不只是 q_d?人靠近时为什么常常只改时钟、不改路径?
为什么独立成章:把 L5 的输出明确成控制层能消费的数据契约,并解释在线重规划为何常常只改时间律。
概念辨析 5 组
核心关系式 本站综合实验 X01
轨迹层 → 控制层的前馈量,来自 L4 动力学模型。
跟踪误差;控制器只负责把实际轨迹拉回给定轨迹。
在线时间重参数化:只换时钟,不换路径。
方法与步骤
- 路径规划 → 轨迹优化 → 可行性检查 → 插补下发 → 控制闭环,逐层明确输入输出。
- 把不可行点定位到具体约束,回退到 M48 重解时间律,而不是直接削掉路径点。
- 需要避障时优先尝试时间重参数化;只有几何本身不安全才调用 L7 重新规划路径。
工程例子 把式子落到真实约束上
协作臂与人共享工作区:人靠近时不下发新路径,只把 s(t) 在对应区间压慢甚至暂停;人离开后按同一路径恢复原时间律,控制层完全不用切换控制器。
轨迹层交给控制层的是 q_d、q̇_d、q̈_d 与前馈量;在线时间重参数化只换 s(t),几何路径与控制器都不用切换。
② 概念台怎么读
误差链:找出第一个出错环节。末端偏了,未必是末端的问题。
看什么:逐环注入误差,看累计误差和「首个出错环节」;后面的环节只会放大前面的错。
滑块分别改变 坐标表达误差、IK 误差、轨迹误差、执行误差;读数板列出中间量与判定。预设「全部正常」等对应最容易出错的几组条件。
概念台边界:② 复用误差链实验台,用来看「轨迹层一个环节的误差会怎样传到闭环」;不仿真真实重规划调度器。
章节依据 可逐条追溯
主干 / 主补充:
- BIAGIOTTI Ch9 从几何路径到轨迹
- CHOSET Ch11 轨迹规划(路径 → 时间律)
- CRAIG Ch7 综合 / Ch9 前导
其他参照:SICILIANO §4.3 轨迹跟踪;Kroger & Wahl 在线时间缩放
先修链 显式 DAG
先修关系写在 curriculum-craig-v2/curriculum.json 的 prereq 字段,50 个模块整体无环、可直接拓扑排序。
编写状态与使用边界 如实标注
使用边界:商业教材只登记公开目录、算法事实与公式;① 是本站已有真实交互实验台,用作兴趣 / 问题引入,不是本模块专属仿真;② 是教学示意模型,数值用于观察关系,不作为工程计算结果。
自测 · 掌握证据
题目:为什么控制层需要 q̈_d 而不只是 q_d? 在线重参数化与重新规划路径,分别在什么情况下该用哪一个?
提示:从 ② 里找证据
先在概念台里复现一组典型条件,再用核心关系式逐项核对读数;能说清「哪个量变了、哪个量没变、为什么」,才算达到本模块的掌握证据。
出处 · 本模块内容来源
- 内容主体
curriculum-craig-v2/curriculum.json与01_课程体系大纲_路径轨迹与控制扩展.md中的章节 M49;主干教材为 Craig《Introduction to Robotics》4/e。 - ① 兴趣引入 站点原有 G1 三维实验台
b02.html,通过?embed=topic嵌入模式复用,未改写原页面代码。 - ② 概念演示 本页新增的参数化 SVG 交互台,用于直观呈现本模块核心关系;教学示意模型,不是真实机器人仿真。
- 主干 / 主补充章节(可逐条追溯) BIAGIOTTI Ch9 从几何路径到轨迹;CHOSET Ch11 轨迹规划(路径 → 时间律);CRAIG Ch7 综合 / Ch9 前导
- 其他参照 SICILIANO §4.3 轨迹跟踪;Kroger & Wahl 在线时间缩放
本页按 A01 单页课件模式生成,承载 v2 体系重写 / 新增的扩展章节;17 份课件独立存放在全新目录,v1 体系、19 份缺口课件、32 份课时课件与 91 模块课件一份未动。① 需经本地 HTTP 服务加载 ES module 与模型;② 为页内 SVG,离线可用。