吴前锐1. 四旋翼飞行控制的核心挑战
四旋翼无人机作为一种典型的欠驱动系统，仅通过四个旋翼的转速调节就要实现空间六自由度的控制，这种强耦合、非线性的控制问题一直是飞行器领域的难点。我在2018年第一次尝试用PID控制四旋翼时，就深刻体会到了这个问题的复杂性——当时飞行器像喝醉了一样在空中画"8"字，最后直接撞上了实验室的窗帘。
传统单级PID控制器在这种场景下暴露出了明显的局限性。当我在户外测试时发现，虽然俯仰角能够快速响应，但位置控制却出现了严重的超调和振荡。这促使我开始研究串级PID架构，其核心思想是将控制问题分解为内外两个闭环：
- 内环（高速环）：负责姿态控制（俯仰、横滚、偏航）
- 外环（低速环）：负责位置控制（X/Y/Z轴）
这种分层结构更符合飞行器的物理特性。内环的响应速度需要比外环快5-10倍，就像骑自行车时我们首先调整的是身体平衡（快速响应），然后才是行进方向（相对慢速调整）。
需要模型API调用？ 免费领10W Token，多模型网关一键接入 Claude、DeepSeek 等主流模型。
2. 串级PID的数学建模过程
2.1 动力学模型建立
在开始调参前，必须建立准确的动力学模型。我参考了Bouabdallah教授提出的经典四旋翼动力学方程，但对其中的电机动力学部分进行了简化：
code复制τ = Kt*(ω²) // 推力与转速平方成正比
M = Km*(ω²) // 扭矩与转速平方成正比
其中Kt和Km需要通过实验测定。我设计了一个简单的测试台架，用拉力计和转速计测量不同PWM值对应的推力和扭矩，最终得到的参数表如下：
| PWM占空比 | 转速 (RPM) | 实测推力 (g) | 计算Kt |
|---|---|---|---|
| 30% | 3200 | 85 | 8.3e-6 |
| 50% | 5200 | 225 | 8.3e-6 |
| 70% | 7100 | 420 | 8.3e-6 |
2.2 串级PID的离散化实现
在实际嵌入式系统中，我采用位置式PID算法而非增量式，因为外环的位置控制需要绝对量输出。离散化公式为：
code复制u(k) = Kp*e(k) + Ki*T*Σe(j) + Kd*(e(k)-e(k-1)