4. VTOL数学建模与实时化

HIL验证的第一步不是接线,而是让机载飞控“相信”自己正处在一架真实飞机上。这个“被相信的对象”就是实时运行的VTOL数学模型。它必须在每个仿真步长内,把飞控输出的舵面、转速指令,转换成传感器应当看到的角速度、加速度、姿态、空速与位置。本节围绕这条“指令→气动力与力矩→刚体运动→传感器”的闭环,讲清模型由哪些块构成、每块怎么实现、以及为了实时性该在哪里做降阶。

坐标系与状态量约定

建模前必须先固定参照系,否则符号错误会直接表现为HIL中姿态发散。本文统一采用:机体坐标系 Ob 原点在重心,xb 指向机头,yb 指向右翼,zb 指向机腹(前右下);地面坐标系 Oe 取北东地(NED)。姿态用四元数 q=[q0,q1,q2,q3] 积分,避免欧拉角奇异。状态量共12维:位置 pe、速度 ve、四元数 q、机体系角速度 ωb。所有气动力与力矩先在机体系计算,再经旋转矩阵 Rbe 转到地面系。

六自由度刚体模型

刚体部分就是牛顿-欧拉方程。平动在机体系写为 m(ṫvb + ωb×vb) = Fb,转动为 J ω̇b + ωb×(Jωb) = Mb。其中 J 为惯量矩阵,对小型VTOL可近似对角阵,例如某4 kg级倾转旋翼机取 J=diag(0.12, 0.18, 0.25) kg·m²(示例假设值)。合力 Fb 包含气动力、旋翼推力、重力投影;合力矩 Mb 包含气动力矩、旋翼推力差动与反扭矩。实现时用四阶龙格-库塔以固定步长 dt=1 ms 积分,四元数每步归一化,防止数值漂移。

气动数据库

气动数据通常来自风洞、CFD或DATCOM,以多维查表形式存在。对VTOL而言,难点是旋翼滑流使机翼处于大迎角、低动压状态,因此气动系数应写成 CL=f(α, Ma, δf, Tc),其中 Tc 为推力系数,用来表征滑流影响。实时实现时把表预加载为定长数组,用线性插值加边界钳位,避免运行时读文件。例如俯仰力矩系数表按 α∈[-10°,20°]、步长2°存储,插值时先定位区间再按比例混合。若某区间数据缺失,应钳位到最近有效值并置一个数据有效标志,供HIL监控界面显示。

旋翼/螺旋桨模型

旋翼模型把转速指令 Ωcmd 变成推力与反扭矩。工程上常用叶素-动量理论简化式:T=CTρA(ΩR)²,Q=CQρA(ΩR)²R。对悬停附近,CT、CQ 可视为常数;进入前飞后需引入来流角修正,用 J=V/(ΩR) 查表得到 CT(J)。倾转旋翼还要把推力按短舱倾角 β 分解到机体系:Fx=T sinβ,Fz=-T cosβ。反扭矩一部分由电机反作用提供,一部分由桨叶阻力产生,需分别建模,否则偏航通道在HIL中会明显偏软。

执行机构模型

飞控输出的是PWM或总线指令,而模型需要的是真实舵偏与转速。执行机构模型至少包含三部分:一是速率限幅,舵机典型最大角速率约 150°/s;二是位置限幅,如升降舵 ±25°;三是一阶惯性环节 τ δ̇ + δ = δcmd,舵机时间常数 τ≈0.02 s,电机转速环 τ≈0.05 s。这三项决定了HIL中飞控看到的相位滞后,若忽略,控制器在真实飞机上容易振荡。实现时对每个通道独立积分,并把限幅后的实际值回写,供飞控遥测对比。

模型降阶与实时性权衡

完整模型可能包含数十个状态,但HIL要求硬实时。降阶的核心是“保留对飞控闭环影响最大的动态”。常用手段有三类:一是准定常假设,把旋翼入流动态 λ̇ 用代数式代替,省去一个快状态;二是忽略高频结构模态,只保留刚体与执行机构;三是把气动表降采样,例如把 α 从1°步长改为2°,误差在可接受范围内而查表耗时减半。判断依据是:降阶前后在相同飞控参数下,姿态阶跃响应的超调与调节时间差异小于10%,且HIL步长能稳定跑在 1 ms 以内。若CPU占用超过70%,优先降气动表分辨率,而不是降积分步长,因为步长直接影响数值稳定性。

VTOL实时模型信号链与降阶取舍 飞控 PWM/总线指令 执行机构模型 限幅·速率·一阶惯性 旋翼/螺旋桨 T=C_TρA(ΩR)² 气动数据库 C_L,C_D,C_m 查表 六自由度 刚体积分 传感器反馈:角速度 / 加速度 / 姿态 / 空速 / 位置 实时性权衡:降阶手段与判断依据 准定常入流 λ̇ 用代数式代替 省去1个快状态 气动表降采样 α 步长 1°→2° 查表耗时减半 忽略结构模态 仅保留刚体+作动 避免高频耦合 验收判据 降阶前后姿态阶跃:超调与调节时间差异 < 10% | HIL步长稳定 ≤ 1 ms | CPU占用 < 70%

一个可执行的降阶检查清单

把上述取舍落到操作上,可用下面这份检查表逐项确认。它不追求覆盖全部细节,而是保证HIL跑起来之前,模型侧的关键风险已被识别。

检查项典型值/做法不通过的表现
积分步长1 ms 固定步长,RK4步长抖动,姿态缓慢漂移
四元数归一化每步归一化姿态矩阵非正交,角度缓慢发散
气动表边界钳位并置有效标志大迎角时力突变,HIL中舵面抖动
执行机构限幅舵 ±25°,速率 150°/s飞控积分饱和,实际舵面跟不上
旋翼反扭矩电机+桨叶分别建模偏航通道响应偏软,悬停航向漂移
降阶验证阶跃对比,差异<10%降阶后控制器增益需重调
若HIL运行中CPU占用突然升高,优先检查气动查表是否被放进了内层循环,以及是否每步都在做字符串或文件操作。把表预加载为数组、把插值写成内联函数,通常能立刻把占用降下来。

完成本节后,模型已经能在实时环境中稳定输出传感器信号。下一步是把这些信号接入真实的飞控硬件接口,并处理时序、电平与故障注入,这正是HIL闭环搭建要解决的问题。