四旋翼无人机双闭环PID控制与动力学建模实践

1. 四旋翼无人机控制系统的核心挑战

四旋翼无人机（UAV）作为典型的欠驱动系统，其动力学特性复杂且具有强耦合性。我在2018年参与农业植保无人机项目时，曾亲眼目睹过PID参数失调导致的"死亡摇摆"现象——由于横滚轴和俯仰轴控制量相互干扰，无人机在3米高度突然失控旋转坠落。这个惨痛教训让我深刻认识到：单纯依靠单环PID控制，根本无法满足四旋翼这种多变量非线性系统的控制需求。

位置与姿态双闭环PID架构的出现，本质上是为了解决两个核心问题：

1. 解耦控制：将空间六自由度运动分解为位置环（外环）和姿态环（内环），通过分层控制降低系统耦合度
2. 抗扰动能力：外环处理环境干扰（如风力扰动），内环抑制机体自身动态特性带来的不稳定因素

2. 动力学建模的关键要素

2.1 坐标系定义与转换

建立准确的动力学模型，首先需要明确定义三个关键坐标系：

1. 地球固定坐标系（E系）：NED（北东地）方向，作为所有运动量的绝对参考
2. 机体坐标系（B系）：原点在重心，X轴指向机头方向
3. 惯性坐标系（I系）：与E系方向相同，原点位于起飞点

坐标转换通过旋转矩阵实现：

matlab复制% 欧拉角转旋转矩阵
R_BI = [cosθ*cosψ, sinφ*sinθ*cosψ-cosφ*sinψ, cosφ*sinθ*cosψ+sinφ*sinψ;
        cosθ*sinψ, sinφ*sinθ*sinψ+cosφ*cosψ, cosφ*sinθ*sinψ-sinφ*cosψ;
        -sinθ,     sinφ*cosθ,                cosφ*cosθ];

注意：当俯仰角θ接近±90°时会出现万向节锁死，此时应改用四元数表示姿态

2.2 刚体动力学方程

基于牛顿-欧拉方程建立动力学模型：

1. 平移运动：
   $$ m \ddot{\xi} = R_{BI} \begin{bmatrix} 0 \ 0 \ \sum F_i \end{bmatrix} - \begin{bmatrix} 0 \ 0 \ mg \end{bmatrix} - k_d \dot{\xi} $$

2. 旋转运动：
   $$ I \dot{\omega} + \omega \times I