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”的问题。
三、风对无人机运动的影响机理
风对无人机运动的影响可分为三类典型机理:
- 平动影响:水平风使无人机产生附加阻力或推力,导致地速与空速不一致。若飞控保持地速恒定,则空速会随风变化,气动力随之改变。
- 姿态影响:侧风会产生侧滑角,诱发滚转力矩和偏航力矩,使无人机出现倾斜或偏航。飞控为保持航向会输出补偿舵量,这一补偿量隐含风信息。
- 旋翼影响:风改变旋翼入流条件,使旋翼拉力效率变化。阵风还会引起旋翼转速波动,表现为电机电流和振动信号的变化。
下表总结了不同风况下无人机的主要响应特征,可作为风估计的特征选择依据:
| 风况 | 主要物理量变化 | 可观测信号 | 估计难度 |
|---|---|---|---|
| 稳定水平风 | 空速与地速差恒定 | GPS地速、姿态角、加速度 | 低 |
| 侧风 | 侧滑角、滚转/偏航力矩 | IMU角速度、磁力计航向 | 中 |
| 阵风 | 气动力突变、旋翼转速波动 | 加速度高频分量、电机电流 | 高 |
| 垂直风切变 | 升力变化、高度波动 | 气压高度、z轴加速度 | 高 |
四、案例与场景:从悬停到前飞的风响应
以四旋翼无人机为例,假设其在无风条件下稳定悬停,此时拉力等于重力,姿态水平。当突然出现来自右侧的稳定风时:
- 相对气流从右侧吹来,产生侧滑角 β;
- 机体右侧阻力增大,产生向左的侧向力;
- 同时产生滚转力矩,使无人机向左倾斜;
- 飞控检测到位置偏移,输出反向滚转补偿,使无人机恢复位置;
- 补偿过程中,滚转角与侧向加速度呈现与风速相关的稳态关系。
若无人机执行前飞任务,迎面风会增大相对气流速度,使气动阻力增大。为保持地速,飞控需要增大前倾角,导致俯仰角与风速之间存在可建模的映射关系。这一映射正是基于模型的风估计方法的核心。
五、常见误区与复盘
在理解风对无人机影响时,初学者常陷入以下误区:
- 把风速直接等同于地速偏差:只有在稳定风且无人机姿态不变的理想情况下,地速与空速之差才近似等于风速。实际中姿态变化、阵风、旋翼入流都会引入误差。
- 忽略姿态补偿:加速度计测量的是比力,包含重力投影。若不进行姿态补偿,重力分量会被误判为风引起的加速度。
- 忽略旋翼动态:旋翼转速变化会改变拉力,进而改变加速度。若仅用刚体方程而不考虑旋翼模型,风估计会出现滞后或偏差。
- 把风当作常值:真实风具有湍流和阵风特性,频率成分丰富。风估计器需要具备一定的带宽,才能跟踪风的变化。
六、本节核心关系图
下图总结了从风到无人机运动响应的完整因果链,以及可观测信号与风估计之间的关系:
该图表明:风通过改变相对气流,进而改变气动力与力矩,最终表现为刚体运动响应;而IMU、GPS、姿态估计和电机转速等信号,正是风估计器可用的观测输入。理解这条因果链,是后续建立风估计模型、设计滤波算法和评估估计精度的前提。