2. GNC系统数学模型基础

GNC（制导、导航与控制）数字仿真平台的可信度，首先取决于数学模型是否自洽。一个航天器在仿真中“飞得对不对”，本质上取决于四类模型是否被正确建立并正确连接：坐标系与转换关系决定了所有矢量在哪表达；轨道与姿态动力学方程决定了状态如何随时间演化；环境力矩模型决定了外部扰动的量级与方向；执行机构与敏感器数学描述决定了控制指令如何变成力矩、测量又如何反馈回状态。本节按这条数据与信号的因果链展开，并给出可直接用于建模的约定与示例参数。

一、坐标系定义与转换：先定约定，再谈方程

GNC仿真中最常见的错误不是积分发散，而是坐标系混用。工程上通常至少需要以下几套坐标系，并明确各自的指向与原点：

• 地心惯性系（ECI，J2000）：原点在地心，X轴指向J2000平春分点，Z轴指向平北极，Y轴按右手定则补齐。轨道动力学方程默认在此系建立。
• 地心固连系（ECEF）：随地球自转，用于地面站、地形与地球引力场带谐项表达。
• 轨道系（RSW/LVLH）：原点在航天器质心，R轴沿地心指向航天器，W轴沿轨道面法向，S轴与轨道运动方向一致。常用于相对运动与轨道误差描述。
• 本体系（Body）：原点在质心，三轴与星体主惯量轴对齐，姿态动力学与执行机构力矩均在此系表达。

转换的核心是方向余弦矩阵（DCM）与四元数。以“本体系相对轨道系”的姿态为例，若采用3-2-1（偏航-俯仰-滚转）欧拉角序列，则本体系到轨道系的DCM可写为 C_bo=C₁(φ)C₂(θ)C₃(ψ)。仿真中更推荐用四元数 q=[q₀,q₁,q₂,q₃]^T 传播姿态，避免欧拉角在±90°附近的奇异。四元数到DCM的转换关系为：

C(q) = [ q0²+q1²-q2²-q3²   2(q1q2+q0q3)     2(q1q3-q0q2)
         2(q1q2-q0q3)       q0²-q1²+q2²-q3²  2(q2q3+q0q1)
         2(q1q3+q0q2)       2(q2q3-q0q1)      q0²-q1²-q2²+q3² ]

约定必须全文一致：本文所有姿态角均指本体系相对轨道系的旋转，旋转顺序为3-2-1，角度正方向按右手定则。若切换到相对惯性系的姿态，需显式说明并重新定义误差角。

二、轨道与姿态动力学方程

轨道部分，在ECI下以位置矢量 r 和速度矢量 v 描述，受地球中心引力与摄动加速度 a_p 作用：

dr/dt = v
dv/dt = -μ·r/|r|³ + a_p

其中 μ=3.986004418×10¹⁴ m³/s²。a_p 至少应包含J2带谐项、大气阻力与三体引力。以500 km圆轨道为例，J2引起的升交点赤经漂移约 -0.03°/天量级，大气阻力引起的半长轴衰减约每天数十米量级，这些量级决定了仿真步长与摄动模型的取舍。

姿态部分，本体系下用刚体欧拉方程描述：

J·dω/dt + ω×(J·ω) = T_ctrl + T_env

J 为惯量矩阵，ω 为本体系相对惯性系的角速度，T_ctrl 为执行机构力矩，T_env 为环境扰动力矩。姿态运动学用四元数传播：

dq/dt = 0.5 · q ⊗ [0, ω]

数值实现上，轨道常用RK4或变步长RK45，姿态常用四元数归一化加RK4。若步长取0.1 s，500 km轨道周期约5677 s，单圈约5.7万步，需关注积分误差累积。

三、环境力矩模型

环境力矩是姿态控制精度与执行机构选型的直接依据。低轨航天器主要考虑四类：

• 重力梯度力矩：T_gg≈(3μ/R³)·(u_R×J·u_R)，与轨道半径三次方成反比。500 km轨道上，惯量差10 kg·m²量级可产生10^-5 N·m量级力矩。
• 气动力矩：T_aero=r_cp×F_drag，F_drag=0.5ρv²C_dA。500 km处ρ约10^-12 kg/m³量级，迎风面积1 m²时阻力约10^-4 N量级，若压心与质心偏差0.1 m，力矩约10^-5 N·m。
• 太阳光压力矩：T_srp=r_cp×F_srp，F_srp≈P·A·(1+ρ_s)·cosθ，P≈4.56×10^-6 N/m²。面积10 m²时约10^-5 N量级。
• 磁力矩：T_mag=m×B，剩余磁矩m=1 A·m²、地磁场B≈3×10^-5 T时，力矩约3×10^-5 N·m。

建模时需注意：环境力矩必须与本体系姿态耦合计算，不能先算惯性系再简单旋转；太阳光压需判断是否处于地影区；气动模型需随轨道高度更新大气密度。

四、执行机构与敏感器数学描述

执行机构方面，动量轮输出力矩 T=K_t·i，同时受饱和转速限制；磁力矩器输出 T=m×B，需与地磁场模型联立；推力器输出 T=r×F，含最小脉冲与上升时间。敏感器方面，星敏感器输出四元数测量，含低频偏差与高频噪声；陀螺输出角速度，含常值漂移与随机游走；太阳敏感器输出角度，含视场与遮挡约束。

下面这张图把本节四类模型串成一条从“状态”到“测量”的闭环信号链，便于对照检查各模块的输入输出与耦合关系。

五、建模检查要点

把上述四类模型接入仿真平台时，建议按以下顺序自检：第一，确认所有矢量在进入方程前已转换到方程所声明的坐标系，尤其是环境力矩必须在本体系计算；第二，确认四元数每步归一化，避免数值漂移导致DCM非正交；第三，确认环境力矩的量级与轨道高度、姿态角、光照条件一致，若某力矩比预期大两个量级，通常是单位或参考系错误；第四，确认执行机构饱和与敏感器噪声被显式建模，否则控制回路在仿真中会“过于理想”。