3. 无人机动力学基础

要让无人机在风场中“感知风、修正航迹”，首先必须理解无人机自身是如何运动的。无人机在空间中的运动可抽象为六自由度（6-DOF）刚体运动：三个平动自由度（沿机体三轴的位置变化）与三个转动自由度（绕机体三轴的姿态变化）。风对无人机的作用，本质上是通过改变气动力与力矩，进而改变这六个自由度的状态量。因此，六自由度方程是风场感知与航迹修正的“物理底座”。

一、核心原理：六自由度运动方程

建立六自由度模型通常采用两套坐标系：地面惯性坐标系（描述位置与航向）和机体坐标系（描述受力与姿态）。设机体轴为 x_b（机头前向）、y_b（右翼）、z_b（机腹向下），则平动方程可写为：

m * (dV_b/dt + ω_b × V_b) = F_b
I * dω_b/dt + ω_b × (I * ω_b) = M_b

其中 V_b = [u, v, w]^T 为机体速度，ω_b = [p, q, r]^T 为机体角速度，F_b 为合外力，M_b 为合力矩，I 为惯性矩阵。姿态运动学则通过欧拉角 [φ, θ, ψ]^T 与角速度耦合：

φ̇ = p + q·sinφ·tanθ + r·cosφ·tanθ
θ̇ = q·cosφ - r·sinφ
ψ̇ = (q·sinφ + r·cosφ) / cosθ

这组方程说明：风一旦改变 F_b 或 M_b，就会同时影响速度、角速度和姿态角，而姿态变化又反过来改变气动力的方向，形成强耦合。这正是风扰下无人机难以保持稳定航迹的根本原因。

二、气动力与力矩：风作用的入口

无人机所受气动力主要来自旋翼拉力、机身阻力与机翼升力。以多旋翼为例，单个旋翼产生的拉力近似为 T = k_T · Ω²，反扭矩为 Q = k_Q · Ω²。当存在相对气流时，机身与桨叶还会产生阻力：

D = 0.5 · ρ · V_air² · S · C_D
L = 0.5 · ρ · V_air² · S · C_L

其中 V_air 是空速，即地速与风速的矢量和：V_air = V_ground - V_wind。这是风影响无人机的关键桥梁——风并不直接“推”无人机，而是改变相对气流，从而改变气动力与力矩。力矩方面，俯仰力矩 M、滚转力矩 L、偏航力矩 N 分别由桨叶拉力差、反扭矩差和机身气动中心偏移产生。风引起的附加力矩会直接激励姿态通道，使无人机出现抬头、侧滑或偏航。

三、风对无人机的作用机理与影响分析

风对无人机的影响可分为三类：平均风、阵风和湍流。平均风造成稳态位置偏移，阵风引起瞬态姿态扰动，湍流则带来高频随机激励。其影响路径如下：

• 平动影响：水平风使无人机产生侧向漂移，垂直风（上升/下沉气流）改变高度保持能力。
• 转动影响：阵风作用于机身侧面产生滚转力矩，作用于机头产生俯仰力矩，导致姿态振荡。
• 控制耦合：姿态扰动使旋翼拉力方向偏离，进而放大位置误差，形成“姿态—位置”耦合发散。
• 能量影响：逆风飞行需增大拉力，电池消耗加快；顺风则可能超速，影响航迹跟踪精度。

下面这张图展示了风扰从输入到六自由度状态输出的完整信号链，以及感知与修正的介入位置：

四、案例与场景：侧风悬停与航迹偏移

假设一架四旋翼在 6 m/s 侧风下执行悬停任务。若飞控不进行风补偿，无人机将被吹向下风方向，同时机身向风侧倾斜以抵抗风阻。此时姿态角 φ 约为 8°～12°，位置漂移速率约等于风速。若飞控仅做姿态稳定而不做位置修正，无人机将保持倾斜但持续漂移；若加入位置环，飞控会通过调整目标姿态使地速为零，从而“斜着悬停”。

在航线飞行中，侧风会使实际航迹偏离预定航线，形成“偏流角”。修正方法有两种：航向修正法（机头偏向来风方向）和侧滑修正法（保持航向、用侧向力抵消）。前者适合长航线，后者适合需要保持传感器指向的任务。

五、常见误区与复盘

复盘时建议按“风输入—空速—气动力矩—六自由度响应—控制补偿”五步逐项检查。若发现航迹修正后仍存在周期性偏移，应重点排查阵风频率与姿态环带宽是否匹配；若出现持续单侧漂移，则应检查风估计是否收敛。只有把六自由度方程、气动力矩和风作用机理串成一条完整链路，后续的风场感知与航迹修正算法才有可靠的物理依据。