R机器人实验室ROBOTICS ATLAS
模块 / M25 / 关节 PID:整定、离散实现与工程约束
v2 课件目录完整实验台 ↗
① G1 实验台 · E02兴趣引入 · 复用原站点演示 复用本站 E02 课时真实 G1 人形实验台;先看整机,再回到本章的人形问题
独立打开 ↗
② 传感—估计—规划—控制链路概念演示 · 与本模块同步 拖参数,看图形与读数

系统慢,不一定是某个算法慢,可能是链路延迟和丢帧。

本模块核心关系 · 教学示意τ[k] = K_p e[k] + K_i T_s Σe + K_d Δe/T_s + ĝ(q)
看什么:调发布频率、延迟、丢帧率,看端到端延迟与有效更新率;超时判定不能只看单个节点。

模块 M25 · L6 控制:从误差动力学到闭环 · 必修 · 单页课件

关节 PID:整定、离散实现与工程约束

会写离散 PID、说明采样周期与带宽的关系,并给出抗积分饱和与微分滤波的实现要点。

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

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

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

同一组关节增益在 1 kHz 下稳定,降到 100 Hz 就振荡;采样、噪声与限幅才是真机调参的主战场。

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

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

同一组增益在 1 kHz 下稳定,为什么降到 100 Hz 就振荡?

为什么独立成章:连续域写对不等于能跑;这一章把采样、噪声、饱和、摩擦这些真正决定成败的实现问题单列。

知识层级L6 · 控制:从误差动力学到闭环
课程性质本科必修 · 3 学时
学习结果会写离散 PID、说明采样周期与带宽的关系,并给出抗积分饱和与微分滤波的实现要点。
概念台模型system

概念辨析 5 组

离散化ZOH 下把积分写成 T_s Σe、微分写成差分;采样周期直接改变等效增益与稳定边界。
微分噪声纯差分放大编码器量化噪声,需要对微分项加低通;滤波又会引入相位滞后。
积分饱和执行器限幅时积分继续累积,退饱和后产生大超调;需 clamping 或 back-calculation。
重力与摩擦补偿把 ĝ(q) 作为前馈加进 τ,让反馈只需处理误差;可显著减小稳态误差与积分负担。
整定流程先 K_p 定刚度与带宽 → K_d 定阻尼 → 最后少量 K_i 消稳态误差 → 全行程复核饱和。

核心关系式 ROS 2 / Nav2 系统接口文档

式 (M25.1)τ[k] = K_p e[k] + K_i T_s Σ e[j] + K_d (e[k]−e[k−1])/T_s + ĝ(q)

离散 PID + 重力前馈;每一项都有对应的工程失效模式。

式 (M25.2)T_s ≲ T_settle/10 , ω_n T_s ≪ 1

采样周期与闭环带宽的经验约束。

式 (M25.3)τ = sat(τ_cmd) ; 积分项在饱和时停止累加

抗积分饱和的基本写法。

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

方法与步骤

  1. 按连续域设计 → 选采样频率 → 离散化 → 加微分滤波 → 加抗饱和。
  2. 在仿真里注入编码器量化噪声与执行器限幅,再回到增益。
  3. 先做重力前馈,再决定是否需要积分。

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

同样的 K_p、K_d 在 1 kHz 下稳定,在 100 Hz 下出现明显振荡;微分项用原始差分还会把编码器量化噪声放大成高频力矩抖动。

离散化把积分写成 T_s Σe、微分写成差分,采样周期直接改变等效增益;执行器饱和时若不停止积分累加,退饱和后会出现大超调。

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

② 概念台怎么读

传感—估计—规划—控制链路。系统慢,不一定是某个算法慢,可能是链路延迟和丢帧。

看什么:调发布频率、延迟、丢帧率,看端到端延迟与有效更新率;超时判定不能只看单个节点。

滑块分别改变 发布频率、链路延迟、丢帧率;读数板列出中间量与判定。预设「正常」等对应最容易出错的几组条件。

概念台边界:② 用「延迟」滑块近似采样 / 通信时滞,用二阶模型看稳定裕度下降;未实现抗饱和与微分滤波的完整代码。

章节依据 可逐条追溯

主干 / 主补充:

  • CRAIG Ch9
  • ÅSTRÖM & HÄGGLUND《PID Controllers》
  • SICILIANO §5.1–5.2

其他参照:MIT OCW 2.12 实现层;CORKE Ch9 控制实现

先修链 显式 DAG

M24反馈控制与误差动力学:稳定性与稳态误差(L6)

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

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

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

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

自测 · 掌握证据

题目:采样周期加倍时,离散微分的等效增益会怎样变化? 执行器已饱和时继续累加积分项,退饱和后会发生什么?

提示:从 ② 里找证据

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

出处 · 本模块内容来源

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

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