2. 基础知识

在进入Plane自主航线规划与飞行控制之前，必须先建立一套统一的“语言系统”。很多飞控调参问题、航线偏离问题、甚至炸机事故，根源往往不在于控制算法本身，而在于工程师对基础物理模型和坐标定义的理解存在偏差。本章将围绕四个核心模块展开：固定翼与多旋翼的升力产生与运动学差异、三大坐标系的定义与转换逻辑、姿态角的物理含义与欧拉角顺序、以及空速与地速在导航解算中的本质区别。这些概念不仅是后续航点规划、PID调参、风场补偿的前提，更是你读懂飞行日志（如Pixhawk的 .bin 文件或ArduPilot的 tlog）的必备钥匙。

2.1 固定翼与多旋翼：升力产生与运动学本质差异

核心原理：升力来源决定控制策略

固定翼飞机的升力主要来源于机翼上下表面的压力差。当飞机以一定速度前进时，气流经过机翼上表面流速快、压力低，下表面流速慢、压力高，从而产生向上的升力。这个升力的大小与空速的平方成正比（L = ½ρV²S·CL）。这意味着固定翼飞机一旦空速过低，升力急剧下降，就会进入失速状态。而多旋翼飞行器的升力完全由螺旋桨的旋转产生，每个旋翼的拉力方向与电机轴线平行，通过改变不同旋翼的转速差来实现姿态变化和位移。多旋翼没有“失速”概念，但存在“桨叶失速”（高前进比下桨叶局部气流分离）和“动力饱和”问题。

从运动学角度看，固定翼是“速度保持型”飞行器，它必须持续保持向前的空速才能维持升力；而多旋翼是“位置保持型”飞行器，它可以悬停、垂直起降，但前飞效率低。在Plane飞控中，固定翼的油门通常与空速闭环（TECS总能量控制系统），而多旋翼的油门与垂直加速度闭环。这一差异直接决定了航线规划策略：固定翼需要规划最小转弯半径（受限于失速速度与最大坡度角），而多旋翼可以原地转向。

判断方法：从飞行日志识别飞行模式

当你拿到一份飞行日志（.bin文件），首先看 CTUN 消息中的 ThrOut（油门输出）和 ARSP（空速）。如果油门输出在巡航段保持稳定且空速基本恒定，说明是固定翼模式；如果油门频繁波动且空速接近地速（无风时），可能是多旋翼模式。另一个判断依据是姿态角变化率：固定翼的滚转速率通常较慢（受限于坡度限制），而多旋翼的滚转速率可以很快（大疆类飞行器可达 90°/s）。

案例拆解：固定翼失速坠毁分析

某次任务中，一架固定翼在逆风返航时坠毁。日志显示：地速为 12 m/s，但空速仅为 9 m/s（低于失速速度 10 m/s）。飞控虽然开启了空速保持，但 ARSPD_FBW_MIN 被误设为 8 m/s，导致飞控认为仍在安全包线内。当飞机转向顺风时，地速突然增大到 18 m/s，但空速进一步下降至 7 m/s，最终进入深度失速。复盘结论：固定翼必须始终监控空速而非地速，且失速保护阈值应留有 20% 余量。

总结复盘：两种机型的控制本质

2.2 三大坐标系：机体、地面与导航

核心原理：坐标系的定义与用途

机体坐标系（Body Frame）原点位于飞行器重心，X轴指向机头，Y轴指向右翼，Z轴向下（右手定则）。它直接描述飞行器自身的姿态和角速度，IMU（惯性测量单元）输出的加速度和角速度就是机体坐标系下的物理量。地面坐标系（Earth Frame）又称NED坐标系（北东地），原点为起飞点，X轴指向正北，Y轴指向正东，Z轴指向地心。导航坐标系（Navigation Frame）通常与地面坐标系重合，但在某些滤波算法中会使用局部切平面坐标系（LLF）或ECEF地心地固坐标系。飞控中的姿态解算本质上是求取机体坐标系到导航坐标系的旋转关系。

在Plane中，AHRS（姿态航向参考系统）模块负责将IMU数据与GPS、空速、磁力计融合，输出四元数或欧拉角。理解坐标系转换的关键在于旋转矩阵：从机体到导航的转换矩阵 C_n^b 由三个欧拉角组成，通常写作 R = R_z(ψ)·R_y(θ)·R_x(φ)。这个矩阵用于将机体坐标系下的加速度转换到导航坐标系，从而计算速度和位置。

操作流程：坐标系转换在飞控中的实际应用

1. IMU校准：飞控上电后，加速度计和陀螺仪输出的是机体坐标系下的原始数据。校准过程就是让飞控记录静止状态下的重力矢量，从而确定机体坐标系与水平面的初始关系。
2. 姿态解算：通过互补滤波或卡尔曼滤波，将陀螺仪积分与加速度计/磁力计观测融合，得到当前姿态四元数 q = [q0, q1, q2, q3]。
3. 速度积分：将加速度计输出 a_b 左乘旋转矩阵得到导航系加速度 a_n = C_n^b·a_b，减去重力后积分得到速度。
4. 位置更新：速度积分得到位置，但GPS会周期性修正累积误差。

案例拆解：坐标系混淆导致的航线偏移

某团队在自定义地面站软件时，将GPS返回的经纬度直接当作导航坐标系下的X/Y坐标使用，忽略了地球曲率和磁偏角修正。结果在飞行500米后，航线偏移了约30米。分析发现：GPS输出的是WGS-84经纬度，需要先转换为UTM或局部切平面坐标，再与机体坐标系下的位置估计融合。正确做法是使用 LOCAL_POSITION_NED 消息，该消息已经由飞控完成坐标系转换。

总结复盘：坐标系选择要点

• 机体坐标系用于控制律设计（角速度环、加速度环）；
• 导航坐标系用于航点规划与位置控制；
• 地面坐标系是导航坐标系的特例，原点固定于起飞点；
• 转换矩阵必须注意旋转顺序，Plane默认使用 Z→Y→X 顺序。

2.3 姿态角：俯仰、滚转、偏航的物理含义

核心原理：欧拉角定义与旋转顺序

姿态角是描述飞行器相对于导航坐标系方向的三参数表示。俯仰角（Pitch, θ）是机体X轴与水平面的夹角，抬头为正；滚转角（Roll, φ）是机体Z轴与包含X轴的铅垂面的夹角，右滚为正；偏航角（Yaw, ψ）是机体X轴在水平面上的投影与正北方向的夹角，顺时针为正。这三个角度的组合可以唯一确定飞行器的空间朝向，但前提是规定旋转顺序。Plane中采用 Z→Y→X 的旋转顺序：先绕Z轴偏航ψ，再绕新Y轴俯仰θ，最后绕新X轴滚转φ。这个顺序避免了万向节锁问题（当θ=±90°时，φ和ψ无法区分）。

在飞控代码中，姿态角通常以弧度存储，但地面站显示为度数。控制律中，内环（角速率环）使用陀螺仪输出的 p、q、r（机体坐标系下的滚转、俯仰、偏航角速率），外环（角度环）使用欧拉角。固定翼的坡度限制（LIM_ROLL_CD）通常设为 45°，而多旋翼可以到 60° 甚至更高。

判断方法：从姿态角判断飞行状态

当俯仰角持续为正且空速下降，说明飞机在爬升减速，可能接近失速；当滚转角长时间大于 30° 且地速方向不变，说明飞机在侧滑，需要检查方向舵或副翼配平。偏航角与航迹角（地面坐标系下的速度方向）的差值即为侧滑角 β，固定翼应尽量保持 β≈0 以减少阻力。

案例拆解：滚转通道极限测试

在一次固定翼特技飞行测试中，飞控设置了 LIM_ROLL_CD = 6000（60°坡度）。当飞行员输入全副翼指令时，飞机滚转速率达到 120°/s，在 0.5 秒内达到 60° 坡度。此时升力垂直分量减少为 cos(60°)=0.5 倍，导致高度下降。飞控的 NAV_L1_PERIOD 参数（L1导航周期）需要相应调整，否则航线跟踪会出现明显超调。测试结论：大坡度机动必须配合高度保持或能量管理。

总结复盘：姿态角与控制律的对应关系

2.4 空速与地速：导航与控制的不同基准

核心原理：两种速度的本质区别

空速（Airspeed, Va）是飞行器相对于空气团的速度，它决定了机翼产生的升力和阻力。空速管（皮托管）通过测量总压与静压之差（动压）来计算空速。地速（Ground Speed, Vg）是飞行器相对于地面的速度，由GPS直接测量，它决定了飞行器从一个航点到另一个航点的实际移动速率。两者之间的关系为：Vg = Va + W，其中 W 是风速矢量。这个矢量关系是风场估计和航线规划的基础。

在Plane中，ARSPD 消息输出空速，GPS 消息输出地速。当两者差值较大时，说明存在强风。固定翼的导航控制器（L1或TECS）使用地速进行航迹跟踪，但空速用于能量管理和失速保护。多旋翼的定位主要依赖GPS地速，但姿态控制仍需要空速信息（如果有空速管）来优化前飞效率。

操作流程：风场估计与补偿

1. 在无风条件下进行校准飞行，记录空速与地速的偏差基线。
2. 飞行中实时计算风速矢量：W = Vg - Va（矢量减法）。
3. 在航线规划中，将风速矢量叠加到期望地速上，得到期望空速。
4. 使用 WIND_EST 参数启用飞控内置的风场估计器，它会自动修正导航控制器的前馈量。

案例拆解：顺风返航的燃油/电量管理

某垂直起降固定翼（VTOL）执行 20 km 往返任务。去程逆风 8 m/s，巡航空速 22 m/s，地速仅 14 m/s，耗时 24 分钟；返程顺风，地速达到 30 m/s，仅耗时 11 分钟。总飞行时间 35 分钟，但电池容量仅支持 30 分钟。复盘发现：任务规划时未考虑风速影响，导致返程电量不足。改进方案：在任务规划软件中输入高空风数据，动态调整航点和巡航速度，确保每个航段的预计时间在安全包线内。

总结复盘：空速与地速的工程应用

• 空速用于：失速保护、升力计算、发动机推力管理；
• 地速用于：航点到达判断、航线跟踪、返航时间估算；
• 风速用于：航线偏移补偿、能量管理、紧急迫降方向选择。