3. 无人机动力学基础

无人机风速风向在线估计,本质上是一个“从运动反推环境”的问题。要准确估计风,必须先理解无人机自身在无风与有风条件下的动力学行为。本节围绕刚体运动方程、气动力与力矩、以及风对无人机运动的影响机理展开,为后续风估计模型建立物理基础。

一、刚体运动方程:六自由度建模框架

无人机在空间中的运动可视为六自由度刚体运动,包括三个平动自由度和三个转动自由度。工程上通常采用机体坐标系与地面坐标系两套坐标系统一描述:

  • 机体坐标系:原点位于无人机质心,x轴指向机头,y轴指向右翼,z轴指向机腹,便于描述气动力与力矩。
  • 地面坐标系:用于描述无人机相对地面的位置、速度和姿态角。

牛顿-欧拉方程给出刚体运动的基本形式:

平动方程:m * (dV_b/dt + ω × V_b) = F_b
转动方程:I * dω/dt + ω × (I * ω) = M_b

其中:
m   —— 无人机质量
V_b —— 机体坐标系下的速度矢量
ω   —— 机体角速度矢量
I   —— 惯性张量
F_b —— 合外力(重力、气动力、推力)
M_b —— 合外力矩(气动力矩、推力力矩)

该方程揭示了两个关键点:一是角速度与速度的耦合项 ω×V_b 会产生科氏效应;二是姿态变化会改变重力在机体轴上的投影,从而影响加速度测量。这正是风估计中必须进行姿态补偿的根本原因。

二、气动力与力矩:风如何“作用”在无人机上

无人机所受气动力主要来自旋翼和机体。对于多旋翼,旋翼拉力沿机体z轴方向,大小与转速平方成正比;而机体在气流中还会产生阻力、侧力和升力。气动力通常表示为:

F_aero = 0.5 * ρ * V_a^2 * S * C_F(α, β)
M_aero = 0.5 * ρ * V_a^2 * S * L * C_M(α, β)

ρ  —— 空气密度
V_a —— 相对气流速度(空速)
S  —— 参考面积
C_F, C_M —— 气动力/力矩系数
α, β —— 迎角与侧滑角

关键变量是相对气流速度 V_a,它等于无人机地速与风速的矢量差:

V_a = V_ground - V_wind

这意味着:即使无人机地速恒定,只要风速变化,气动力就会改变。风通过改变相对气流,直接改变气动力与力矩,进而改变无人机的加速度和角加速度。因此,风估计问题可以转化为“从气动力响应反推 V_wind”的问题。

核心结论:风对无人机的影响不是直接施加一个“风力”,而是通过改变相对气流速度,改变气动力与力矩,最终体现在加速度和姿态变化上。

三、风对无人机运动的影响机理

风对无人机运动的影响可分为三类典型机理:

  1. 平动影响:水平风使无人机产生附加阻力或推力,导致地速与空速不一致。若飞控保持地速恒定,则空速会随风变化,气动力随之改变。
  2. 姿态影响:侧风会产生侧滑角,诱发滚转力矩和偏航力矩,使无人机出现倾斜或偏航。飞控为保持航向会输出补偿舵量,这一补偿量隐含风信息。
  3. 旋翼影响:风改变旋翼入流条件,使旋翼拉力效率变化。阵风还会引起旋翼转速波动,表现为电机电流和振动信号的变化。

下表总结了不同风况下无人机的主要响应特征,可作为风估计的特征选择依据:

风况 主要物理量变化 可观测信号 估计难度
稳定水平风 空速与地速差恒定 GPS地速、姿态角、加速度 低
侧风 侧滑角、滚转/偏航力矩 IMU角速度、磁力计航向 中
阵风 气动力突变、旋翼转速波动 加速度高频分量、电机电流 高
垂直风切变 升力变化、高度波动 气压高度、z轴加速度 高

四、案例与场景:从悬停到前飞的风响应

以四旋翼无人机为例,假设其在无风条件下稳定悬停,此时拉力等于重力,姿态水平。当突然出现来自右侧的稳定风时:

  • 相对气流从右侧吹来,产生侧滑角 β;
  • 机体右侧阻力增大,产生向左的侧向力;
  • 同时产生滚转力矩,使无人机向左倾斜;
  • 飞控检测到位置偏移,输出反向滚转补偿,使无人机恢复位置;
  • 补偿过程中,滚转角与侧向加速度呈现与风速相关的稳态关系。

若无人机执行前飞任务,迎面风会增大相对气流速度,使气动阻力增大。为保持地速,飞控需要增大前倾角,导致俯仰角与风速之间存在可建模的映射关系。这一映射正是基于模型的风估计方法的核心。

工程提示:在实际风估计中,不要只依赖单一信号。建议融合IMU加速度、姿态角、GPS地速、电机转速等多源信息,利用刚体运动方程构建观测模型,再通过卡尔曼滤波或递推最小二乘估计风速风向。

五、常见误区与复盘

在理解风对无人机影响时,初学者常陷入以下误区:

  1. 把风速直接等同于地速偏差:只有在稳定风且无人机姿态不变的理想情况下,地速与空速之差才近似等于风速。实际中姿态变化、阵风、旋翼入流都会引入误差。
  2. 忽略姿态补偿:加速度计测量的是比力,包含重力投影。若不进行姿态补偿,重力分量会被误判为风引起的加速度。
  3. 忽略旋翼动态:旋翼转速变化会改变拉力,进而改变加速度。若仅用刚体方程而不考虑旋翼模型,风估计会出现滞后或偏差。
  4. 把风当作常值:真实风具有湍流和阵风特性,频率成分丰富。风估计器需要具备一定的带宽,才能跟踪风的变化。
复盘要点:风估计的精度上限,取决于对刚体运动方程、气动力模型和旋翼模型的建模精度。若模型过于简化,再好的滤波算法也无法弥补物理层面的偏差。

六、本节核心关系图

下图总结了从风到无人机运动响应的完整因果链,以及可观测信号与风估计之间的关系:

风—气动力—运动响应—风估计因果链 风场 风速 V_wind / 风向 相对气流 V_a = V_ground − V_wind 气动力与力矩 F_aero, M_aero 刚体运动 六自由度响应 可观测信号(传感器输出) IMU 加速度 / 角速度 GPS 地速 / 位置 姿态估计 滚转 / 俯仰 / 偏航 电机转速 PWM / 电流 产生 风估计器 刚体运动方程 + 气动模型 + 滤波算法 输出:风速估计 V̂_wind / 风向估计 输入特征 模型反馈与校正

该图表明:风通过改变相对气流,进而改变气动力与力矩,最终表现为刚体运动响应;而IMU、GPS、姿态估计和电机转速等信号,正是风估计器可用的观测输入。理解这条因果链,是后续建立风估计模型、设计滤波算法和评估估计精度的前提。