1. 无人机姿态控制的重要性与挑战
在固定翼无人机的飞行控制中，姿态保持是最基础也最关键的环节。其中俯仰角（Pitch）控制直接决定了飞行器的爬升、俯冲和水平飞行状态。一个典型的场景是：当无人机遇到阵风干扰时，俯仰角可能突然变化5-10度，此时控制系统需要在0.5秒内将角度偏差纠正到±1度以内，同时角速度不超过15°/s，否则可能导致失速或结构过载。
传统PID控制器在这个场景下会遇到三个典型问题：
- 参数固定导致抗扰动能力差 - 当遇到强风扰时，固定的Kp可能产生过大控制量引发振荡
- 非线性工况适应性弱 - 在不同飞行速度下，飞机的气动特性差异很大
- 超调与快速性的矛盾 - 减小超调会延长调节时间，影响飞行品质
2. 状态空间建模与常规PID设计
2.1 无人机纵向动力学建模
我们建立的俯仰轴状态空间方程包含四个关键状态变量：
- 俯仰角θ（单位：弧度）
- 俯仰角速率q（单位：弧度/秒）
- 空速u（单位：米/秒）
- 攻角α（单位：弧度）
状态矩阵A的典型形式如下：
code复制A = [-0.045 0.036 0 -9.8;
-0.371 -2.47 0 0;
-0.011 -0.039 -0.5 0.49;
0 1 0 0 ]
这个矩阵的物理意义在于：
- 第一行反映空速变化率与各状态的关系
- 第二行描述俯仰角加速度的动态特性
- 第三行表示攻角变化率
- 第四行定义俯仰角与角速率的积分关系
2.2 常规PID控制器设计
采用Ziegler-Nichols整定法得到的初始PID参数：
- 比例增益Kp = 2.5
- 积分时间Ti = 0.8秒
- 微分时间Td = 0.2秒
在MATLAB中实现的离散化公式：
code复制u(k) = u(k-1) + Kp*[e(k)-e(k-1)] + (Kp*T/Ti)*e(k) + (Kp*Td/T)*[e(k)-2e(k-1)+e(k-2)]
其中采样周期T取20ms，对应典型飞控系统的运行频率。
3. 模糊自适应PID控制设计
3.1 模糊化接口设计
定义两个输入变量：
- 俯仰角误差e：论域[-15°,15°]，分为5个模糊集
- 误差变化率ec：论域[-30°/s,30°/s]，同样分为5个模糊集
采用三角形隶属函数，关键参数如下：
code复制误差e的隶属函数参数：
NB: [-15 -15 -7.5]
NS: [-15 -7.5 0]
ZO: [-7.5 0 7.5]
PS: [0 7.5 15]
PB: [7.5 15 15]
3.2 模糊规则库设计
建立25条模糊规则，典型规则示例：
code复制IF e is PB AND ec is NB THEN ΔKp is PB, ΔKi is NB, ΔKd is PS
IF e is ZO AND ec is ZO THEN ΔKp is ZO, ΔKi is ZO, ΔKd is ZO
输出变量的解模糊采用重心法，计算公式：
code复制ΔKp = ∑(μi*ci)/∑μi
其中ci为输出模糊集的中心值，μi为激活度。
3.3 参数自适应机制
PID参数的在线调整公式：
code复制Kp = Kp0 + α*ΔKp
Ki = Ki0 + β*ΔKi
Kd = Kd0 + γ*ΔKd
其中α、β、γ为调整系数，通过实验确定为：
- α = 1.2
- β = 0.05
- γ = 0.3
4. 仿真对比与性能分析
4.1 阶跃响应对比
在10°阶跃输入下：
| 指标 | 常规PID | 模糊PID | 改进幅度 |
|---|---|---|---|
| 调节时间(s) | 1.8 | 0.9 | 50% |
| 超调量(%) | 12.5 | 4.2 | 66% |
| 峰值角速度(°/s) | 28.7 | 19.3 | 33% |
4.2 抗扰动测试
在5秒时施加持续1秒的-5°俯仰力矩扰动：
- 常规PID最大偏差：7.2°
- 模糊PID最大偏差：3.8°
- 恢复时间对比：2.1s vs 0.7s
5. 实现要点与调试经验
5.1 模糊规则优化技巧
在实际调试中发现三个关键经验：
- 当误差和误差变化率同号时，应显著增大Kp并适当减小Ki
- 在误差接近零但变化率较大时，需要提高Kd抑制超调
- 积分项调整幅度应小于其他两项，避免积分饱和
5.2 实时性保障措施
在STM32H743平台上的实现优化：
- 将模糊查询表预先存储在Flash中
- 采用定点数运算（Q15格式）
- 限制参数调整频率为100Hz
实测单次调整耗时<50μs，满足实时性要求
6. 典型问题解决方案
6.1 高频抖动问题
现象：在稳态时出现±0.3°的高频振荡
解决方法：
- 增加误差死区（deadband）±0.1°
- 限制Kd的最大变化率
- 在规则库中添加ZO-ZO区域的保持规则
6.2 大角度响应慢
现象：从20°偏差恢复时初始响应迟缓
优化措施：
- 增加非线性误差映射：e' = sign(e)*sqrt(|e|)
- 设置参数调整的误差阈值窗口
- 引入前馈补偿项