📚 课程目录第2章固定翼飞机基础

2. 固定翼飞机基础

固定翼飞行控制律设计的首要任务，是建立一套严谨的数学语言来描述飞机的空间运动状态。无论是经典的增益预置（Gain Scheduling）控制，还是现代的非线性动态逆（NDI）控制，其底层都依赖于对“飞机现在朝向哪里”和“飞机正在如何转动”的精确描述。本章将系统梳理机体坐标系与地面坐标系的定义、欧拉角的旋转逻辑，并深入对比方向余弦矩阵（DCM）与四元数两种姿态表示方法的工程适用场景，为后续的动力学建模与控制器设计奠定坚实的数学基础。

2.1 坐标系定义与转换关系

核心原理：固定翼飞机的运动学描述必须建立在明确的坐标系基准之上。工程实践中，最常用的是地面坐标系（Earth Frame，记为 \(F_E\)）和机体坐标系（Body Frame，记为 \(F_B\)）。地面坐标系采用北-东-下（NED）惯例，原点固定于地面某参考点，\(X_E\) 指向正北，\(Y_E\) 指向正东，\(Z_E\) 垂直于地面向下。机体坐标系的原点固定在飞机重心，\(X_B\) 沿机身轴线指向机头，\(Y_B\) 垂直于飞机对称面指向右翼，\(Z_B\) 垂直于 \(X_B O Y_B\) 平面指向机身下方。两个坐标系均为右手直角坐标系。

飞机相对于地面的姿态，本质上就是机体坐标系 \(F_B\) 相对于地面坐标系 \(F_E\) 的旋转关系。这一旋转关系可以通过三种数学工具来描述：欧拉角、方向余弦矩阵和四元数。三者之间可以相互转换，但在不同应用场景下各有优劣。

  工程要点：在飞控计算机中，惯性测量单元（IMU）输出的原始数据是机体坐标系下的角速率和加速度。而导航和控制律计算通常需要在地面坐标系下进行。因此，坐标系转换是飞控软件中最基础、最高频的运算之一。转换精度和计算效率直接影响控制品质。

2.2 欧拉角定义与旋转顺序

核心原理：欧拉角通过三次连续旋转来描述姿态。固定翼领域普遍采用 3-2-1 旋转顺序（即先偏航、再俯仰、最后滚转），对应的角度分别为偏航角 \(\psi\)（绕 \(Z_E\) 轴）、俯仰角 \(\theta\)（绕新的 \(Y\) 轴）和滚转角 \(\phi\)（绕新的 \(X_B\) 轴）。这种顺序的物理意义是：先确定机头水平指向（偏航），再确定机头上下倾斜（俯仰），最后确定机翼绕机身轴线的旋转（滚转）。

判断方法与操作流程：在实际飞行中，欧拉角的获取通常通过以下步骤完成：

传感器采集：IMU 中的陀螺仪输出机体坐标系下的三轴角速率 \(p, q, r\)（单位：rad/s）。
姿态更新：利用运动学方程 \(\dot{\phi} = p + q\sin\phi\tan\theta + r\cos\phi\tan\theta\)、\(\dot{\theta} = q\cos\phi - r\sin\phi\)、\(\dot{\psi} = (q\sin\phi + r\cos\phi)/\cos\theta\) 进行积分。
传感器融合：由于陀螺仪存在漂移，通常使用加速度计和磁力计数据通过互补滤波或卡尔曼滤波对欧拉角进行修正。

欧拉角	旋转轴	符号	范围	物理意义
偏航角	\(Z_E\)	\(\psi\)	\([-180°, +180°]\)	机头相对于正北的水平指向
俯仰角	\(Y\)（旋转后）	\(\theta\)	\([-90°, +90°]\)	机头相对于水平面的上下倾斜
滚转角	\(X_B\)	\(\phi\)	\([-180°, +180°]\)	机翼绕机身轴线的旋转

关键风险——万向节锁：当俯仰角 \(\theta = \pm 90°\) 时，\(\cos\theta = 0\)，上述运动学方程中的 \(\tan\theta\) 项趋于无穷大，导致偏航角与滚转角无法唯一解耦。此时欧拉角描述失效，表现为飞机垂直爬升或俯冲时的姿态解算奇异。这是欧拉角方法在飞控中最大的局限性。

2.3 方向余弦矩阵（DCM）

核心原理：方向余弦矩阵是一个 \(3 \times 3\) 的正交矩阵 \(R\)，其元素 \(r_{ij}\) 表示机体坐标系第 \(i\) 轴与地面坐标系第 \(j\) 轴之间夹角的余弦值。DCM 将地面坐标系中的向量 \(\vec{v}_E\) 变换到机体坐标系：\(\vec{v}_B = R \cdot \vec{v}_E\)。DCM 的转置 \(R^T\) 则实现反向变换。

DCM 的更新方程基于陀螺仪角速率：\(\dot{R} = R \cdot [\omega]_\times\)，其中 \([\omega]_\times\) 是角速率向量 \(\omega = [p, q, r]^T\) 的反对称矩阵。由于数值积分误差会导致 DCM 失去正交性，工程上需要定期进行正交化修正（如 Gram-Schmidt 正交化）。

  工程案例——DCM在姿态解算中的应用：某小型固定翼无人机采用 DCM 作为姿态表示。初始姿态为水平（\(\psi=0°, \theta=0°, \phi=0°\)），DCM 为单位矩阵。飞行中陀螺仪测得角速率 \(p=0.1 rad/s, q=0.05 rad/s, r=0.02 rad/s\)。经过 10 秒积分后，DCM 元素出现微小偏差，导致坐标转换后的重力向量与加速度计测量值产生约 0.5° 的角度误差。通过引入加速度计和磁力计的修正项，并每 100 个控制周期执行一次正交化，最终姿态误差控制在 0.1° 以内，满足飞控需求。

2.4 四元数表示法

核心原理：四元数是一个四维超复数 \(q = q_0 + q_1 i + q_2 j + q_3 k\)，其中 \(q_0\) 为标量部分，\(q_1, q_2, q_3\) 为向量部分。单位四元数满足 \(q_0^2 + q_1^2 + q_2^2 + q_3^2 = 1\)，可以表示三维空间中的任意旋转。四元数避免了欧拉角的奇异问题，且计算量小于 DCM，因此在现代飞控计算机中应用最为广泛。

操作流程——四元数姿态更新：

初始化：将初始欧拉角转换为四元数：\(q_0 = \cos(\phi/2)\cos(\theta/2)\cos(\psi/2) + \sin(\phi/2)\sin(\theta/2)\sin(\psi/2)\)，依此类推。
微分方程更新：使用 \(\dot{q} = \frac{1}{2} q \otimes \omega\)（\(\otimes\) 为四元数乘法）进行数值积分。
归一化：每步积分后执行 \(q \leftarrow q / \|q\|\)，防止模长漂移。
转换回欧拉角：用于控制律计算和地面站显示。

对比维度	欧拉角	方向余弦矩阵	四元数
参数数量	3	9	4
奇异问题	有（万向节锁）	无	无
计算量（更新）	小（但含三角函数）	大（9个元素积分）	中（4个元素积分）
物理直观性	高	低	低
典型应用	地面站显示、人机交互	理论推导、坐标变换	飞控解算、导航滤波

工程经验：在飞控代码中，建议内部姿态解算统一使用四元数，仅在需要输出给地面站或进行人机交互时转换为欧拉角。这样可以避免频繁的三角函数计算，同时彻底规避万向节锁问题。转换公式为：\(\phi = \text{atan2}(2(q_0 q_1 + q_2 q_3), 1 - 2(q_1^2 + q_2^2))\)，\(\theta = \text{asin}(2(q_0 q_2 - q_3 q_1))\)，\(\psi = \text{atan2}(2(q_0 q_3 + q_1 q_2), 1 - 2(q_2^2 + q_3^2))\)。

2.5 姿态表示方法的选型与工程实践

判断方法：在固定翼飞控系统设计中，姿态表示方法的选择应基于以下准则：

控制律设计阶段：使用欧拉角进行线性化建模，因为小角度假设下欧拉角与角速率的关系可以简化为 \(\dot{\phi} \approx p, \dot{\theta} \approx q, \dot{\psi} \approx r\)，便于经典控制理论分析。
导航解算阶段：使用四元数进行姿态积分，因为飞行包线内可能包含大俯仰角机动（如筋斗、大角度爬升），四元数无奇异且计算效率高。
地面站显示：将四元数转换为欧拉角，便于飞行员和地面操作人员直观理解。

  实战案例——某飞翼无人机姿态解算设计：某飞翼布局无人机（无垂尾）执行大迎角机动时，俯仰角达到 85°，接近万向节锁边界。若采用欧拉角直接积分，姿态解算在 \(\theta = 89°\) 时出现数值发散，导致控制律输出错误指令。设计团队将姿态解算核心切换为四元数，并在扩展卡尔曼滤波（EKF）中采用四元数状态向量。切换后，飞机在 \(\theta = 88°\) 的机动中姿态误差保持在 0.3° 以内，控制律工作正常。复盘发现，四元数归一化步骤中的浮点精度损失是主要误差来源，通过改用双精度浮点运算并将归一化频率从 100Hz 提升至 400Hz，误差进一步降低至 0.1°。

常见误区：初学者常将欧拉角直接用于大机动飞行控制，导致奇异问题。另一个常见错误是忽略四元数的归一化，长时间运行后四元数模长偏离 1，造成姿态漂移。务必在每个控制周期（通常 100-400Hz）执行归一化，并在传感器融合算法中监控四元数模长作为健康度指标。

总结复盘：本章建立了固定翼姿态描述的完整知识框架。核心要点可归纳为：地面坐标系提供惯性参考基准，机体坐标系描述飞机本体方向；欧拉角直观但存在万向节锁，DCM 无奇异但计算量大，四元数在计算效率和数值稳定性之间取得最佳平衡。在实际飞控系统中，推荐采用“四元数内部解算 + 欧拉角外部显示”的混合架构。下一阶段将在此基础上，引入飞机的线速度、角速度与受力关系，建立六自由度刚体动力学方程。