模块 M51 · L6 控制:从误差动力学到闭环 · 必修 · 单页课件
模型前馈与计算力矩控制
能写出计算力矩控制律,说明它如何把耦合非线性系统化为解耦二阶系统,并分析模型误差的后果。
内容主体:本科机器人学课程体系 v2(Craig 骨架 · 路径轨迹与控制扩展)中的章节正文;以 G1 人形机器人为贯穿案例 | 配套:① 原站点演示 + ② 本模块概念交互台
人形机器人 · 本章引入 G1 案例
高速挥臂时惯性耦合不能忽略;计算力矩用动力学模型预先抵消非线性,让每个关节像独立二阶系统。
① 的真实 G1 三维实验台是这一章的兴趣引入:先在左栏看整机的姿态与读数,把「这台人形机器人为什么需要本章」提出来;再到 ② 把核心关系亲手拖一遍。
本节要解决的问题 章节定位
计算力矩为什么必须拿到 q̈_d?把负载质量估错 30% 后闭环方程里多出什么?
为什么独立成章:把 L4 的动力学真正用进控制器:这是「轨迹层输出 q̈_d」的兑现处,也是 Craig Ch10 的核心。
概念辨析 5 组
核心关系式 Craig Ch9–10;Ogata;MIT Underactuated Ch8
计算力矩控制律(Craig Ch10 的标准形式)。
名义模型精确时,非线性被完全抵消。
模型误差以扰动形式回到误差方程,引出 M54。
方法与步骤
- 获取或辨识 M、h → 由轨迹层取 q̈_d → 每周期算力矩 → 叠加 PD 反馈。
- 在仿真里人为改动负载质量,观察跟踪误差随模型误差增大。
- 与纯 PID 在低速 / 高速两组轨迹下做受控对比,量化差异。
工程例子 把式子落到真实约束上
同一条高速抓取轨迹:独立关节 PID 在加减速段出现明显相位滞后;计算力矩把惯性耦合预先补掉,误差下降一个量级;但把负载质量设错 30% 后优势明显缩小。
τ = M(q)(q̈_d + K_v ė + K_p e) + h(q,q̇) 用名义模型抵消非线性,把耦合系统化为 n 个解耦二阶系统;模型误差以 Δ 扰动形式回到误差方程。
② 概念台怎么读
二阶闭环阶跃响应。改增益与时延,看超调、调节时间与稳定裕度怎么变。
看什么:看响应曲线与 ±2% 调节带;比较 Kp / Kd 与通信延迟对超调、RMS 误差与稳态误差的影响。
滑块分别改变 比例增益 Kp、微分增益 Kd、延迟;读数板列出中间量与判定。预设「临界阻尼 ζ=1」等对应最容易出错的几组条件。
概念台边界:② 用二阶响应示意「模型精确时误差被抵消」与「有扰动时残留误差」;未实现 6R 臂的 M(q) 与 h(q,q̇) 实时计算。
章节依据 可逐条追溯
主干 / 主补充:
- CRAIG Ch10 非线性控制
- SICILIANO §5.2 计算力矩
- CORKE Ch9 动力学控制
其他参照:MIT Manipulation Ch? 模型前馈;KHALIL《Modeling, Identification and Control of Robots》
先修链 显式 DAG
先修关系写在 curriculum-craig-v2/curriculum.json 的 prereq 字段,50 个模块整体无环、可直接拓扑排序。
编写状态与使用边界 如实标注
使用边界:商业教材只登记公开目录、算法事实与公式;① 是本站已有真实交互实验台,用作兴趣 / 问题引入,不是本模块专属仿真;② 是教学示意模型,数值用于观察关系,不作为工程计算结果。
自测 · 掌握证据
题目:计算力矩为什么需要轨迹层提供 q̈_d? 把负载质量估错时,闭环误差方程里多出来的是什么?
提示:从 ② 里找证据
先在概念台里复现一组典型条件,再用核心关系式逐项核对读数;能说清「哪个量变了、哪个量没变、为什么」,才算达到本模块的掌握证据。
出处 · 本模块内容来源
- 内容主体
curriculum-craig-v2/curriculum.json与01_课程体系大纲_路径轨迹与控制扩展.md中的章节 M51;主干教材为 Craig《Introduction to Robotics》4/e。 - ① 兴趣引入 站点原有 G1 三维实验台
c02.html,通过?embed=topic嵌入模式复用,未改写原页面代码。 - ② 概念演示 本页新增的参数化 SVG 交互台,用于直观呈现本模块核心关系;教学示意模型,不是真实机器人仿真。
- 主干 / 主补充章节(可逐条追溯) CRAIG Ch10 非线性控制;SICILIANO §5.2 计算力矩;CORKE Ch9 动力学控制
- 其他参照 MIT Manipulation Ch? 模型前馈;KHALIL《Modeling, Identification and Control of Robots》
本页按 A01 单页课件模式生成,承载 v2 体系重写 / 新增的扩展章节;17 份课件独立存放在全新目录,v1 体系、19 份缺口课件、32 份课时课件与 91 模块课件一份未动。① 需经本地 HTTP 服务加载 ES module 与模型;② 为页内 SVG,离线可用。