4、飞控系统调参：PID控制器原理、姿态环与位置环调优、震动滤波处理
飞控调参这件事，说白了就是让无人机“听话”。你给它一个指令，它能不能干净利落地执行？遇到风能不能稳住？这背后全是PID的功劳。我见过太多人一上来就乱调参数，结果飞机在天上跟喝醉了似的。今天咱们就把这事掰开揉碎了讲清楚。
4.1 PID控制器原理：别把它想得太玄乎
PID就是比例、积分、微分三个环节的组合。你想想看，你要让飞机保持水平——
- P（比例）：当前偏了多少，就给多大修正力。偏得多拉得猛，偏得少拉得轻。
- I（积分）：一直有残余偏差？积分项慢慢累积，把那个“顽固偏差”吃掉。
- D（微分）：偏差变化有多快？提前预判，抑制超调。
我在项目中遇到过一架飞机，悬停时总往一边飘。P调大了就振荡，调小了又回不正。后来发现是重心偏了，积分项一直在硬扛。嗯，这里要注意：PID不是万能的，机械结构的问题别指望靠调参解决。
核心公式（位置式PID）：
u(t) = Kp * e(t) + Ki * ∫e(t)dt + Kd * de(t)/dt实际飞控里常用增量式PID，避免积分饱和。但原理是一样的。
4.2 姿态环调优：让飞机“稳如老狗”
姿态环是飞控的最内环，直接控制角速度。我习惯先调内环，再调外环。顺序搞反了，你会陷入死循环。
4.2.1 调参步骤（以PX4为例）
- 先调P：给一个阶跃指令，观察响应。P太小反应慢，P太大开始振荡。找到临界振荡点，然后P取60%~70%。
- 再加D：D能抑制振荡。我一般从0.01开始往上加，直到响应干脆利落、没有过冲。
- 最后调I：I用来消除稳态误差。但I太大会导致积分饱和，起飞时可能突然抬头。
我的经验：调姿态环时，先把飞机绑在测试架上。别一上来就飞，炸机成本太高。我曾经图省事直接飞，结果P给大了，飞机在地上翻了三个跟头……
4.2.2 常见问题与对策
| 现象 | 可能原因 | 对策 |
|---|---|---|
| 高频振荡（嗡嗡声） | P过大或D过小 | 降低P，或增加D |
| 低频摇摆（像喝醉） | P过小或I过大 | 增加P，或降低I |
| 回中慢、反应迟钝 | P过小 | 适当增加P |
| 悬停时缓慢漂移 | I不足或重心偏移 | 增加I，同时检查重心 |
4.3 位置环调优：让飞机“指哪打哪”
位置环在姿态环外面。说白了，位置环告诉姿态环“该往哪偏”，姿态环负责执行。所以位置环的响应速度要比姿态环慢很多，否则内外环会打架。
我习惯把位置环的P设成姿态环P的1/5到1/3。举个例子，姿态环P=0.15，位置环P就从0.03开始试。位置环的I一般很小，甚至可以为0，因为位置偏差主要靠外环的P来消除。
注意：位置环的D项容易引入噪声。GPS信号稍微跳一下，D项就会放大成剧烈的修正。我建议位置环D设为0，或者加一个强低通滤波。
4.4 震动滤波处理：别让噪声毁了你的参数
震动是飞控调参的头号杀手。你辛辛苦苦调好的参数，一上天就振荡，十有八九是震动惹的祸。
为什么会这样？因为IMU（惯性测量单元）对震动极其敏感。桨叶不平衡、电机轴承磨损、机架共振，都会在加速度计和陀螺仪数据里叠加高频噪声。这些噪声被PID的D项放大，结果就是飞机高频抖动。
4.4.1 震动来源排查
- 机械层面：桨叶动平衡、电机座减震垫、飞控安装是否牢固。
- 滤波层面：低通滤波器截止频率、陷波滤波器设置。
- 软件层面：采样率、数据融合算法。
我遇到过一架六轴，悬停时陀螺仪Z轴噪声高达±5°/s。查了半天，发现是飞控直接硬连接在碳板上，没有减震泡沫。贴了一层3M减震胶，噪声直接降到±0.5°/s。你看，有时候问题就这么简单。
4.4.2 滤波器设置建议
| 滤波器类型 | 适用场景 | 推荐参数 |
|---|---|---|
| 低通滤波器（LPF） | 抑制高频噪声 | 截止频率：40~80Hz（视机架大小） |
| 陷波滤波器（Notch） | 抑制特定频率共振 | 中心频率：通过频谱分析确定 |
| 滑动平均滤波 | 平滑数据 | 窗口大小：3~5个采样点 |
我的习惯：先做一次频谱分析，看看震动峰值在哪些频率上。然后针对性地设置陷波滤波器。别盲目加低通，滤波太狠会导致相位滞后，飞控反应变慢。
4.5 调参流程总览
下面这张图是我自己总结的调参流程。每次调参都按这个走，基本不会出大问题。
嗯，这里要强调一下：调参不是一次性的工作。换了桨叶、改了负载、甚至换了电池品牌，都可能需要重新微调。我习惯每次飞行前看一眼日志里的震动数据，心里有个底。
避坑指南：我曾经在调参时犯过一个低级错误——把姿态环和位置环的P设成一样大。结果飞机在GPS模式下疯狂点头，差点炸机。记住，位置环的响应速度一定要比姿态环慢，给内环留出执行时间。
好了，关于PID调参的核心内容就这些。记住三个关键词：先内后外、先机械后软件、先滤波后调参。按这个顺序走，你的飞控会越来越听话。