2. 轨道动力学基础回顾

轨道参数估计与修正的所有算法，最终都要落到一个可计算的动力学模型上。本节把后续章节反复使用的三块基础重新梳理清楚：二体问题的运动方程、轨道六根数的几何含义、以及状态矢量与轨道根数之间的双向转换。这三者构成一个闭环——估计器从观测量反推状态矢量或轨道根数，修正算法再依据动力学模型外推和调整，因此必须先把它们之间的数学关系理顺。

一、二体问题：最简但不可替代的动力学模型

二体问题假设航天器与中心天体是仅受彼此引力作用的两个质点，忽略其他摄动。设中心天体引力常数为 μ=GM，航天器相对中心天体的位置矢量为 r，则运动方程为：

r̈ = -μ · r / |r|³

该方程存在解析解，其核心结论是：轨道是圆锥曲线，且满足比角动量守恒 h = r × v 与比机械能守恒 ε = v²/2 − μ/r。这两个守恒量直接决定了轨道形状与大小，也是后续所有根数定义的物理来源。需要强调的是，二体模型是"参考模型"而非真实模型：地球非球形引力（J2 项量级约 1×10⁻³）、大气阻力、日月三体引力等都会使真实轨道偏离二体解。参数估计中通常把二体解作为先验或初值，把摄动作为待估修正量处理，因此二体模型的精度直接决定了估计收敛的快慢。

二、轨道六根数：把三维运动压缩成六个标量

二体轨道在惯性空间中的几何由六个独立参数完全确定，即轨道六根数。它们可以分成三组理解：

• 形状与大小：半长轴 a 决定轨道尺度，偏心率 e 决定轨道扁平程度。e=0 为圆轨道，0<e<1 为椭圆轨道，e=1 为抛物线，e>1 为双曲线。
• 轨道面朝向：倾角 i 是轨道面与赤道面的夹角，升交点赤经 Ω 从春分点方向量到升交点方向，二者共同锁定轨道面在惯性空间中的姿态。
• 轨道面内方位：近地点幅角 ω 从升交点量到近地点，真近点角 f 从近地点量到航天器当前位置，二者确定航天器在轨道面内的具体位置。

这六个量中，a 与 e 是几何量，i、Ω、ω 是姿态量，f 是时间相关量。工程上常用平近点角 M 或偏近点角 E 替代 f 作为时间参数，三者通过开普勒方程 M = E − e·sinE 联系。轨道根数的优势在于物理意义直观、便于长期外推；劣势在于当 e→0 或 i→0 时，ω、Ω 的定义会出现奇异，此时需要改用春分点根数等无奇异元素。

三、状态矢量与轨道根数的互转

状态矢量指惯性系下的位置 r=(x, y, z) 与速度 v=(vx, vy, vz)，共六个分量。它与轨道根数描述同一轨道，但适用场景不同：数值积分、滤波估计通常用状态矢量，任务规划、轨道设计通常用根数。两者互转是轨道估计流程中的标准环节。

由状态矢量求根数的典型顺序是：先算比角动量 h=r×v 和偏心率矢量 e=(v×h)/μ − r/r，得到 e=|e|；再由能量关系 a = 1/(2/r − v²/μ) 求半长轴；由 h 与 z 轴夹角求 i；由节点矢量 n=k×h 求 Ω；由 n 与 e 的夹角求 ω；最后由 e 与 r 的夹角求 f。每一步都需用点积和叉积判断象限，避免反三角函数只返回主值导致符号错误。

由根数求状态矢量则先在近焦点坐标系（PQW）中写出位置和速度：

r_PQW = [ p·cos f / (1 + e·cos f),  p·sin f / (1 + e·cos f),  0 ]
v_PQW = [ -√(μ/p)·sin f,            √(μ/p)·(e + cos f),        0 ]

其中 p = a(1−e²) 为半通径。再通过三次旋转 Rz(−Ω)·Rx(−i)·Rz(−ω) 把 PQW 分量变换到惯性系，即得 r、v。这一变换矩阵也是后续误差传播和协方差转换的基础。

四、一个可复算的示例

设某近地轨道在 ECI 系下的状态矢量为（示例数据，用于演示流程）：r=(7000, 0, 0) km，v=(0, 7.5, 1.0) km/s，取 μ=398600.4418 km³/s²。按上述顺序计算：

把得到的根数再代回 PQW→ECI 变换，应能还原出原始 r、v，误差在浮点精度范围内。这个"正算—反算—比对"的闭环是验证互转程序正确性的标准手段，也是后续估计器初始化时检查初值合理性的常用方法。

五、从基础到估计与修正的衔接

把上述内容放回参数估计的语境中，可以看清三条衔接线索。第一，状态矢量是估计器的状态量：卡尔曼滤波、最小二乘批处理通常直接以 r、v 或其偏差作为待估向量，因为其动力学递推是线性的、无奇异。第二，轨道根数是结果解释与任务约束的载体：估计完成后往往要转成根数，才能判断半长轴漂移、倾角变化是否满足任务要求。第三，互转矩阵是协方差传播的桥梁：状态矢量的协方差阵 P 通过雅可比矩阵 J=∂(根数)/∂(状态矢量) 映射为根数协方差 J·P·Jᵀ，这一步在精度评估和误差分配中必不可少。