2. 航天器GNC系统建模基础
半实物仿真能否可信,首先取决于被仿对象模型是否“物理正确、接口一致、量纲统一”。GNC(制导、导航与控制)系统的被控对象是航天器本体及其轨道、姿态运动,而仿真回路中又接入真实星载计算机、真实或等效的执行机构与敏感器。因此本节围绕四件事展开:轨道与姿态动力学模型、执行机构与敏感器模型、坐标系定义与转换、模型接口规范。它们共同决定了仿真中“状态如何演化、力矩如何产生、测量如何生成、模块如何对接”。
一、轨道与姿态动力学:状态量与动力学方程
轨道动力学描述航天器质心在惯性空间中的运动。工程上常用惯性系下的位置矢量 r 与速度矢量 v 作为状态量,其动力学为:
dr/dt = v
dv/dt = -μ·r/|r|³ + a_pert
其中 μ 为地球引力常数(约 3.986×10⁵ km³/s²),a_pert 为摄动加速度之和,典型包括 J2 项(地球扁率)、大气阻力、太阳光压与三体引力。以 500 km 圆轨道为例,轨道角速度约 1.1×10⁻³ rad/s,周期约 95 min;J2 引起的升交点赤经漂移在数百米每秒量级,仿真中若忽略 J2,长时间轨道位置误差会显著累积。因此半实物仿真中,轨道模型至少应包含二体项与 J2 项,并按任务精度决定是否加入大气阻力。
姿态动力学描述航天器绕质心的转动。以本体坐标系相对惯性系的姿态四元数 q 与本体角速度 ω 为状态量,刚体姿态动力学为:
dq/dt = 0.5 · q ⊗ [0, ω]ᵀ
I·dω/dt = T_ctrl + T_dist - ω × (I·ω)
其中 I 为惯量矩阵,T_ctrl 为控制力矩,T_dist 为干扰力矩(如气动、剩磁、重力梯度)。注意 ω × (I·ω) 为陀螺耦合项,在大角速度机动时不可忽略。姿态运动学与动力学必须成对积分,且四元数需周期归一化,否则数值漂移会破坏姿态正交性。
二、执行机构与敏感器模型
执行机构把控制指令转换为力矩或推力。反作用飞轮模型通常包含:力矩指令限幅、一阶惯性环节(时间常数约 0.05~0.2 s)、转速饱和与摩擦力矩。例如某飞轮最大力矩 0.1 N·m、最大转速 6000 r/min,当转速接近上限时输出力矩迅速衰减,仿真中必须体现该饱和特性,否则会得到“控制永远有效”的错误结论。推力器模型则需考虑最小脉冲宽度、推力上升/下降时间与安装位置产生的力臂。
敏感器模型把真实物理量转换为测量输出。星敏感器输出姿态四元数,需建模安装矩阵、视场遮挡、更新率(如 1~10 Hz)与测量噪声;陀螺输出角速度,需建模零偏、随机游走与标度因数误差;太阳敏感器与磁强计则提供矢量方向测量。半实物仿真中,敏感器模型常以“真实状态 + 误差模型 + 量化”的方式生成模拟信号,再通过接口送入真实星载计算机,从而检验其滤波与定姿算法。
三、坐标系定义与转换
GNC 建模中最易出错的是坐标系。常用坐标系包括:地心惯性系(J2000)、轨道系、本体系、敏感器系与执行机构系。约定:本体系相对惯性系的姿态用四元数 q_bi 表示,表示从惯性系到本体系的旋转;轨道系 x 轴沿速度方向、z 轴指向地心、y 轴构成右手系。任意矢量在两系间的转换统一写为:
v_body = C_bi · v_inertial
C_bi = (q_bi 对应的方向余弦矩阵)
安装矩阵 C_bs 描述敏感器系相对本体系的固定旋转,标定后应作为常量写入模型。所有模块必须显式声明输入输出矢量所属坐标系,禁止“默认同一系”的隐式假设。方向与正负号约定一旦确定,全文与图示必须一致。
四、模型接口规范
半实物仿真中,模型之间通过标准接口交换数据。接口规范应明确:数据名称、物理含义、单位、坐标系、更新周期、数据类型与有效范围。例如姿态接口输出 q_bi(无量纲,4 维)与 ω_bi_b(rad/s,本体系,3 维),更新周期 10 ms;飞轮指令接口输入力矩(N·m,3 维),输出转速(r/min,3 维)。接口周期不一致时需明确采样与保持策略,避免因时序错位导致仿真发散。
五、建模实践中的关键检查点
在把上述模型接入半实物仿真前,建议按以下顺序自查。第一,量纲与单位:轨道用 km 还是 m、角速度用 rad/s 还是 °/s,必须与接口表一致,否则会出现数量级错误。第二,坐标系一致性:敏感器输出若在本体系,控制律若在轨道系计算,必须显式转换,不能默认相同。第三,积分步长:轨道二体运动可用 0.1~1 s,姿态控制回路通常需 1~10 ms,两者可分别积分再通过接口交互。第四,饱和与限幅:飞轮转速、推力器最小脉宽、敏感器量程都应在模型中体现,否则仿真结果偏乐观。第五,初值与参考:轨道初值、姿态初值、陀螺零偏初值应记录在案,便于复现与对比。
以某对地观测卫星为例,设轨道半长轴 6878 km、偏心率 0.001、倾角 98°,姿态初始为本体系相对轨道系三轴稳定,飞轮最大力矩 0.1 N·m、最大转速 6000 r/min,星敏更新率 4 Hz、噪声 5″(1σ),陀螺零偏 0.5 °/h。仿真中若姿态误差在 0.05° 以内、飞轮转速未持续饱和、轨道位置 24 h 内偏差小于 1 km,则可认为模型与接口基本正确。这些数值属于教学示例,实际任务需按具体指标调整。
综上,轨道与姿态动力学提供状态演化,执行机构与敏感器模型提供物理边界与测量特性,坐标系定义与转换保证各模块“说同一种语言”,接口规范则保证数据在正确的时间以正确的单位与坐标系流动。四者缺一不可,共同构成 GNC 半实物仿真可信建模的基础。