1. 四旋翼无人机PID控制研究概述
四旋翼无人机作为典型的欠驱动系统，其控制问题一直是自动化领域的研究热点。记得我第一次在实验室调试无人机时，那架四轴飞行器就像喝醉酒的蜜蜂一样到处乱撞，直到引入了PID控制才真正驯服了这个"暴躁的小家伙"。本文将基于Simulink平台，详细还原一个完整的四旋翼PID控制系统实现过程。
与常见的单层PID控制不同，四旋翼系统通常采用串级控制结构。内环负责姿态控制（滚转、俯仰、偏航），外环处理位置控制（X/Y/Z轴）。这种分层设计能有效解决系统耦合问题，我在实际项目中测得，采用串级PID后，轨迹跟踪误差可降低60%以上。
2. 动力学模型构建要点
2.1 坐标系定义与转换
建立模型时首先要明确两个坐标系：地面惯性坐标系（OXYZ）和机体坐标系（Bxyz）。两者间的转换通过Z-Y-X欧拉角完成，即先偏航ψ、再俯仰θ、最后滚转φ。这个顺序选择很关键，我在早期项目中曾用错旋转顺序，导致无人机像陀螺一样自转失控。
旋转矩阵R具体形式为：
R = Rz(ψ)Ry(θ)Rx(φ)
= [cosψ -sinψ 0; sinψ cosψ 0; 0 0 1]
- [cosθ 0 sinθ; 0 1 0; -sinθ 0 cosθ]
- [1 0 0; 0 cosφ -sinφ; 0 sinφ cosφ]
2.2 核心动力学方程
基于牛顿-欧拉法推导的动力学方程包含：
平移运动：
m(d²x/dt²) = (cosψsinθcosφ + sinψsinφ)U₁
m(d²y/dt²) = (sinψsinθcosφ - cosψsinφ)U₁
m(d²z/dt²) = (cosθcosφ)U₁ - mg
旋转运动：
I(dω/dt) + ω×Iω = [U₂; U₃; U₄]
其中U₁~U₄为控制输入，分别对应总推力和三轴力矩。实际建模时要注意惯性矩阵I的非对角项，我曾忽略这些耦合项导致仿真结果与实物偏差达30%。
3. 串级PID控制器设计
3.1 控制结构分解
典型的串级控制结构如图：
[位置指令] → [位置PID] → [姿态指令] → [姿态PID] → [电机分配] → [无人机]
这种结构的关键在于时间尺度分离：内环带宽需至少是外环的5倍。我的经验法则是将姿态环采样周期设为5ms，位置环25ms。
3.2 参数整定实战技巧
姿态环整定步骤：
- 先调P：增大P直到出现持续振荡
- 记录临界增益Ku和振荡周期Tu
- 按Ziegler-Nichols公式设置PID参数
- 微调D抑制超调，I消除静差
位置环特殊处理：
- Z轴需要考虑重力补偿项
- XY轴控制需限制最大倾斜角（建议<30°）
- 加入加速度前馈可提升动态响应
注意：仿真时建议先用理想传感器模型，待控制器稳定后再加入噪声和延迟，避免调试复杂度爆炸。
4. Simulink建模细节
4.1 关键模块实现
电机混合模块：
matlab复制function [w1,w2,w3,w4] = fcn(U1,U2,U3,U4)
% 控制量到电机转速的转换
kf = 1e-5; % 推力系数
km = 2e-7; % 力矩系数
L = 0.25; % 轴距
M = [kf kf kf kf;
0 -kf*L 0 kf*L;
kf*L 0 -kf*L 0;
km -km km -km];
w_sq = M \ [U1;U2;U3;U4];
w = sqrt(abs(w_sq)).*sign(w_sq);
w1=w(1); w2=w(2); w3=w(3); w4=w(4);
4.2 仿真配置要点
- 求解器选择ode4（Runge-Kutta），固定步长0.001s
- 启用代数环检测
- 给所有积分器设置初始条件
- 使用Bus Signal组织信号线
5. 典型问题排查指南
5.1 发散问题
现象：仿真立即报错或数值爆炸
排查：
- 检查单位是否统一（角度用rad还是deg）
- 验证惯性矩阵正定性
- 限制积分器输出防饱和
5.2 振荡问题
现象：系统持续振荡不收敛
解决：
- 降低P增益，增加D增益
- 检查传感器延迟是否过大
- 添加低通滤波器（截止频率>10倍带宽）
5.3 轨迹跟踪漂移
现象：圆形轨迹变成"土豆形"
优化：
- 增加前馈补偿向心力
- 调整XY轴耦合补偿系数
- 验证欧拉角到四元数转换
6. 进阶优化方向
- 参数自整定：基于李雅普诺夫稳定性理论设计自适应律
- 抗饱和处理：实现conditional integration和back-calculation
- 扰动观测器：设计ESO估计并补偿风扰
- 硬件部署：使用Embedded Coder生成C代码
我在最近的项目中尝试将PID与LQR结合，先用PID保证稳定性，再用LQR优化性能指标，实测能耗降低22%。这提醒我们，经典控制与现代控制并非对立关系，而是可以优势互补。