飞行控制基础：飞行动力学模型、姿态角、角速度、加速度、控制回路（内环/外环）基本概念
飞行控制参数调优的前提，是建立对飞行器运动本质的清晰认知。任何一架固定翼或多旋翼飞行器，其空间运动都可以分解为质心的平动与绕质心的转动。理解飞行动力学模型、姿态角、角速度、加速度之间的数学与物理关系，以及内环/外环控制回路的层级逻辑，是后续所有调参工作的理论基石。本章将围绕这些核心概念展开，帮助读者建立从物理量到控制结构的完整映射。
2.1 飞行动力学模型：从物理定律到控制对象
飞行动力学模型是描述飞行器在力和力矩作用下运动规律的数学表达。在飞行控制工程中，我们通常采用刚体假设，将飞行器视为质量不变的刚体，其运动由牛顿第二定律和欧拉方程共同描述。平动部分由力方程 F = m·a 决定，转动部分由力矩方程 M = I·ω̇ + ω×(I·ω) 决定，其中 I 为惯性张量，ω 为角速度向量。
在实际工程中，完整的六自由度模型包含三个平动自由度和三个转动自由度。平动方程描述飞行器在三维空间中的位置变化，转动方程描述其姿态变化。两者通过姿态角（欧拉角或四元数）相互耦合——姿态决定了推力和气动力的方向，而平动加速度又反过来影响姿态动力学。这种耦合关系是飞行控制中最核心的难点之一。
2.2 姿态角、角速度与加速度：状态量的物理意义与测量
姿态角（欧拉角）描述飞行器机体坐标系相对于地面坐标系的旋转关系，包括滚转角 φ（Roll）、俯仰角 θ（Pitch）和偏航角 ψ（Yaw）。姿态角是外环控制（如位置控制、速度控制）的输入，也是飞行员或自动驾驶仪感知飞行器“朝向”的直接量。角速度（p, q, r）是机体坐标系下绕三轴的旋转速率，由陀螺仪直接测量，是内环（角速度环）的核心反馈量。加速度（ax, ay, az）由加速度计测量，包含重力分量和运动加速度，是速度环和位置环的重要输入。
三者之间存在明确的积分/微分关系：角速度积分得到姿态角增量，姿态角通过方向余弦矩阵（DCM）或四元数转换为地面坐标系下的加速度分量。在控制回路中，角速度环通常作为最内环，因为角速度的响应速度最快、延迟最小；姿态角环次之；位置环最外，响应最慢。这种由内到外的层级结构，决定了调参的顺序——必须先稳定内环，再逐层向外扩展。
| 状态量 | 测量传感器 | 典型更新率 | 在控制回路中的角色 | 调参影响 |
|---|---|---|---|---|
| 角速度 (p,q,r) | 陀螺仪 (IMU) | 1-8 kHz | 内环反馈，阻尼与快速响应 | Kp_rate 过大→振荡；过小→迟钝 |
| 姿态角 (φ,θ,ψ) | 加速度计+陀螺仪融合 | 100-500 Hz | 姿态环反馈，稳定姿态角 | Kp_att 过大→超调；过小→漂移 |
| 加速度 (ax,ay,az) | 加速度计 | 1-4 kHz | 速度环/位置环前馈与补偿 | 前馈增益不当→风扰响应差 |
| 速度 (Vx,Vy,Vz) | GPS/光流/空速管 | 5-50 Hz | 外环速度控制 | Kp_vel 过大→位置振荡 |
| 位置 (X,Y,Z) | GPS/视觉/气压计 | 5-20 Hz | 最外环位置控制 | Kp_pos 过大→轨迹超调 |
2.3 控制回路分层：内环/外环的串级架构
现代飞行控制系统普遍采用串级PID（Cascade PID）结构，将控制任务分解为多个嵌套的回路。以多旋翼为例，从内到外依次为：角速度环（Rate Loop）→ 姿态角环（Angle Loop）→ 速度环（Velocity Loop）→ 位置环（Position Loop）。每一层回路都有明确的控制目标和带宽要求。
角速度环是最内层，直接输出电机/舵面指令。它的带宽最高（通常 50-200 rad/s），负责提供系统的阻尼和快速响应。角速度环的PID参数直接决定了飞行器对扰动的抑制能力——例如突风引起的角速度变化，需要角速度环快速修正。姿态角环位于角速度环之外，输出角速度指令。它的带宽较低（约 10-30 rad/s），负责将姿态角误差转换为期望角速度。姿态角环的输出是角速度环的输入，因此姿态环的增益变化会直接影响角速度环的参考输入。
速度环和位置环属于外环，带宽更低（1-10 rad/s），主要用于导航和轨迹跟踪。外环的输出作为内环的参考指令，形成级联关系。这种串级结构的核心优势在于：每一层回路只负责一个物理量，内环的快速响应可以抑制外环的扰动，外环的慢速调整保证稳态精度。调参时必须遵循“先内后外”的原则——如果内环不稳定，外环无论如何调整都无法获得良好性能。
2.4 案例拆解：多旋翼悬停调参中的内环/外环联动
以一架四旋翼在GPS悬停模式下的调参为例。初始现象：飞行器在悬停时出现低频左右摇摆（约0.5 Hz），且位置漂移明显。通过日志分析发现：角速度环的跟踪误差较小（< 2°/s），但姿态角环的误差较大（±5°），且位置环输出频繁饱和。
分析判断过程：首先检查角速度环——从日志中提取滚转通道的角速度指令与实际角速度，发现两者几乎重合，说明角速度环响应良好。接着检查姿态角环——姿态角指令（来自位置环）与实际姿态角之间存在明显滞后和超调，说明姿态环增益偏低或阻尼不足。进一步检查位置环——位置误差达到0.8m，位置环输出的姿态角指令达到8°，接近限幅值，说明位置环增益过高或速度环响应不足。
实际操作步骤：
- 将位置环增益
Kp_pos从 1.2 降至 0.8，速度环增益Kp_vel从 3.0 降至 2.2，减少外环对内环的过度驱动。 - 将姿态环增益
Kp_att从 4.5 提高至 5.5，同时增加姿态环微分Kd_att从 0.1 至 0.15，提高姿态回正速度并增加阻尼。 - 保持角速度环参数不变（P=0.08, D=0.004），因为其跟踪性能已满足要求。
- 重新进行悬停测试，观察姿态角误差是否收敛至 ±2° 以内。
结果对比：调整后，悬停摇摆幅度从 ±5° 降至 ±1.5°，位置漂移从 0.8m 降至 0.2m。飞行器在阵风扰动下的恢复时间从 3s 缩短至 1.2s。代价是姿态环增益提高后，在高速飞行时可能出现轻微的高频抖动，后续通过降低角速度环D增益来平衡。
复盘经验：本次调参的核心教训是——外环增益过高会“激励”内环产生振荡，而内环的阻尼不足会放大外环的指令噪声。调参不是孤立地调整某一环，而是需要理解各环之间的带宽分离原则：内环带宽至少应为外环的 5-10 倍，否则会出现回路间耦合振荡。
2.5 常见误区与总结复盘
误区一：只调内环，忽略外环。很多初学者认为内环（角速度环）是“核心”，只要内环稳定就万事大吉。实际上，外环（位置/速度环）的增益设置不当，会导致内环持续收到饱和指令，最终引发振荡。正确做法是内外环协同调整，遵循“先内后外、逐层验证”的原则。
误区二：忽视加速度反馈的作用。加速度计不仅用于姿态解算，在速度环和位置环中，加速度前馈可以显著提高抗风扰能力。如果忽略加速度反馈，仅依赖GPS速度反馈，会导致位置控制滞后严重。建议在调参时关注加速度前馈增益（如PX4中的 ACCEL_P 参数）。
误区三：所有飞行模式使用同一套参数。手动模式（Acro）主要依赖角速度环，定高模式（AltHold）需要姿态环和垂直速度环配合，GPS模式（PosHold）则依赖完整的外环链路。不同模式对参数敏感度不同，应分别调优并保存独立的参数组。