ADRC-2.最速跟踪微分器TD-参数整定与工程实践
1. 最速跟踪微分器TD的核心原理与工程意义
最速跟踪微分器（Tracking Differentiator，简称TD）是自抗扰控制（ADRC）中的关键组件，它的核心任务是实现信号的无超调快速跟踪。想象一下开车时的刹车过程：既要快速接近目标位置，又要在到达时刚好速度降为零，避免"冲过头"。这正是TD在控制系统中扮演的角色。
在电机位置伺服系统中，TD的工作原理可以类比为"智能导航"：
- **x1(k)**相当于当前车辆位置
- **x2(k)**相当于当前车速
- fh计算出的最优加速度就像导航系统实时计算的最佳刹车力度
与普通微分器不同，TD通过独特的非线性结构实现了两个重要特性：
- 有限时间收敛：能在最短时间内到达目标值
- 无超调跟踪：到达目标时速度恰好归零
在实际嵌入式实现中，我们常用改进的fhan函数算法，其数学表达包含三个关键参数：
// 关键参数结构体示例 typedef struct { float x1; // 位置状态量 float x2; // 速度状态量 float h; // 基本步长 float h0; // 滤波步长 float r; // 速度因子 float N0; // 步长倍数 float fh; // 输出加速度 } Fhan_Data;2. 参数物理意义与选型指导
2.1 速度因子r的实战选择
速度因子r直接决定系统的"激进程度"，就像调节汽车油门的灵敏度。在给永磁同步电机调试时，我发现：
r值过大（如10000）：跟踪速度极快，但会导致：
- 电机电流剧烈波动（实测波形出现尖峰）
- 机械传动部件异响
- 超过驱动器最大允许加速度
r值过小（如100）：响应迟缓，无法发挥系统潜能
工程选型公式：
r ≈ 0.8 * (2 * a_max) / h0²其中a_max是被控对象允许的最大加速度。例如某伺服电机a_max=200rad/s²，h0=0.01时，r≈16000。
2.2 步长参数h与h0的协同调节
这对参数相当于控制系统的"时间分辨率"：
| 参数 | 作用 | 过小的影响 | 过大的影响 | 典型取值 |
|---|---|---|---|---|
| h | 计算步长 | 计算负担增加 | 跟踪精度下降 | 0.001-0.01s |
| h0 | 滤波步长 | 滤波效果弱 | 响应延迟明显 | 20*h |
在STM32F407上的实测数据：
// 参数组合效果对比 {h=0.001, h0=0.02} // 最佳平衡点 {h=0.0005, h0=0.01} // 计算量翻倍，超调仅改善3% {h=0.002, h0=0.04} // 响应延迟增加50ms3. 嵌入式实现的五大实战技巧
3.1 代码优化策略
在资源受限的单片机中，我优化fhan函数的经验：
- 查表法处理sqrt：预计算平方根表，牺牲少量精度换取速度
- 定点数优化：将float转为Q格式定点数，STM32上速度提升40%
- 避免实时计算Sign函数：用条件判断替代
优化后的代码片段：
// 优化后的符号函数实现 inline int32_t Sign_ADRC(float x) { return (x > 0) ? 1 : ((x < 0) ? -1 : 0); } // 使用移位替代乘除 a1 = sqrt_lut[(int32_t)(d*(d+8*abs(y)))>>16];3.2 噪声抑制的工程方法
在直流电机控制中，编码器噪声会导致TD输出抖动。通过三管齐下解决：
- 参数层面：适当减小h（但不少于控制周期）
- 硬件层面：增加RC低通滤波
- 软件层面：对x2进行移动平均滤波
实测效果对比：
- 未处理时速度波动：±15RPM
- 三重处理后：±3RPM
4. 参数整定的四步调试法
根据多年现场经验，总结出可复用的调试流程：
4.1 阶跃响应测试法
- 设置初始参数：h=0.001, h0=0.02, r=1000
- 给50%幅度的阶跃信号
- 观察响应曲线：
- 若上升沿有振荡：减小r或增大h0
- 若上升速度慢：增大r
- 重复直到获得临界阻尼响应
4.2 频域验证法
通过扫频信号验证TD在不同频率下的跟踪性能：
- 幅频特性曲线应保持-3dB带宽内平坦
- 相频特性延迟要小于控制系统要求
某工业机械臂的验收标准：
频率≤10Hz时，幅值误差<5% 相位延迟<15°5. 典型问题排查指南
5.1 超调问题排查
现象：到达目标位置后仍有振荡 解决方案：
- 检查h0是否足够大（建议h0≥20h）
- 确认速度因子r未超过系统最大加速度限制
- 在代码中加入输出限幅：
// 输出限幅保护 if(fabs(fh) > fh_max) { fh = Sign_ADRC(fh) * fh_max; }5.2 响应迟钝排查
现象：跟踪速度明显慢于预期 检查步骤：
- 确认实时性：计算耗时是否超过控制周期
- 验证参数传递：检查参数是否被意外修改
- 测试输入信号：确认给定信号本身无延迟
在调试某型号AGV时，发现因CAN通信周期10ms导致TD始终滞后，改为定时器中断执行后解决。