4. 轨迹跟踪的基本架构

轨迹跟踪是航天器制导律从“规划”走向“执行”的核心环节。它要解决的问题可以概括为：给定一条期望的参考轨迹，如何让航天器在存在初始偏差、模型不确定性和外部扰动的情况下，仍然沿这条轨迹飞行。要回答这个问题，必须先把跟踪系统的整体架构讲清楚——它由参考轨迹生成、跟踪误差定义、反馈控制回路、前馈补偿以及闭环稳定性判断五个相互关联的部分组成。理解这五者的分工与耦合关系，是后续设计具体制导律的基础。

参考轨迹生成：跟踪的“目标”从哪来

参考轨迹是跟踪系统的输入基准，通常记为 r(t)，包含位置、速度乃至加速度的期望时间历程。在航天任务中，参考轨迹的来源主要有三类：一是由轨道力学解析或数值积分得到的标称轨道，例如霍曼转移的椭圆过渡段；二是由制导算法在线优化生成的轨迹，例如燃料最优的连续推力轨迹；三是由任务约束（如交会走廊、着陆锥角限制）反推得到的可行轨迹。无论来源如何，参考轨迹必须满足两个条件：物理可实现（满足动力学方程和推力约束）和可微（至少二阶可导，以便提取前馈加速度）。

以近地轨道交会为例，设目标航天器在圆轨道上运行，追踪器需要从后方 50 km 处接近到 1 km 的保持点。参考轨迹可以设计为一条相对运动坐标系下的直线加平滑过渡曲线，其位置 r(t) 用五次多项式描述，保证起点和终点的位置、速度、加速度连续。这样生成的 r(t) 才能作为后续误差定义和前馈计算的可靠基准。

跟踪误差定义：把“偏差”变成可控制的量

跟踪误差是参考轨迹与实际状态之间的差。最直接的定义是位置误差 e = r(t) - x(t)，其中 x(t) 是航天器实际位置。但在控制设计中，仅用位置误差往往不够，因为速度误差同样影响收敛品质。因此更常用的是状态误差向量：

e = [r(t) - x(t);  r_dot(t) - x_dot(t)]

其中 r_dot(t) 和 x_dot(t) 分别为参考速度和实际速度。这个二维误差向量同时包含了位置和速度的偏差信息，便于后续设计比例-微分型控制律。需要注意的是，误差定义必须在同一坐标系下进行。如果参考轨迹在惯性系给出，而实际状态在轨道系测量，就必须先统一到同一坐标系再作差，否则误差的物理意义会被坐标变换扭曲。

误差定义还决定了跟踪的“严格程度”。例如在交会任务中，位置误差的权重通常高于速度误差；而在编队飞行中，相对位置和相对速度的误差需要同时约束。实际工程中常引入加权矩阵 Q，用 e^T Q e 作为综合误差指标，把不同方向的误差按任务需求区分对待。

反馈控制回路：误差驱动的闭环修正

反馈控制回路的作用是根据当前误差实时计算控制量，使误差趋于零。最典型的形式是 PD 控制：

u_fb = -K_p * e_pos - K_d * e_vel

其中 K_p 和 K_d 分别为位置增益和速度增益矩阵。这个控制量通过推力器或动量轮作用到航天器上，改变其运动状态，从而减小误差。反馈回路的本质是“用误差说话”：误差越大，修正越强；误差趋近于零，控制量也趋近于零。

但反馈有一个固有局限——它总是“事后”修正。如果参考轨迹本身需要持续加速度，仅靠反馈会在跟踪过程中产生稳态滞后。例如参考轨迹是一条匀加速直线，PD 控制下的实际轨迹会始终落后一个与加速度成正比的小量。这个滞后量虽然可以通过增大增益来减小，但增益过大会引入振荡甚至失稳。因此，反馈回路需要前馈补偿来“提前”提供参考轨迹所需的控制量。

前馈补偿：让控制“未卜先知”

前馈补偿的思路是：既然参考轨迹 r(t) 已知，那么维持这条轨迹所需的标称控制量 u_ff 也可以提前算出来。对于航天器动力学 x_ddot = f(x, u)，前馈控制量满足：

u_ff = f_inv(r(t), r_dot(t), r_ddot(t))

即把参考轨迹的位置、速度、加速度代入动力学逆模型，解出所需的推力或力矩。以连续推力航天器为例，若参考轨迹的加速度为 a_ref，则前馈推力为 u_ff = m * a_ref（忽略摄动）。这个量直接“喂”给执行机构，使航天器在没有任何误差时也能沿参考轨迹飞行。反馈回路只需处理初始偏差和扰动引起的残差，负担大大减轻。

前馈与反馈的配合关系可以用一句话概括：前馈负责“跟踪标称”，反馈负责“修正偏差”。两者叠加得到总控制量 u = u_ff + u_fb。这种结构在工程上称为“前馈-反馈复合控制”，是轨迹跟踪最常用的架构。

闭环稳定性：跟踪能否收敛的判据

把前馈和反馈接入动力学后，整个系统变成一个闭环。闭环稳定性的问题是：当初始误差不为零或存在扰动时，误差 e 是否会收敛到零？对于线性化后的系统，可以用误差动力学方程来判断：

e_ddot + K_d * e_dot + K_p * e = d(t)

其中 d(t) 为扰动和模型误差的等效项。若 K_p 和 K_d 选取为正定矩阵，且满足阻尼比和自然频率的合理配置，则齐次方程的解是指数衰减的，误差最终收敛到零附近。这就是闭环稳定性的基本结论。

实际工程中还需要考虑两个问题：一是增益不能无限增大，因为执行机构有饱和限制，过大的增益会导致控制量饱和，反而破坏稳定性；二是模型误差和外部扰动会留下稳态误差，需要积分项或自适应律来消除。因此，稳定性分析通常要结合李雅普诺夫方法或频域裕度来综合判断，而不是只看增益符号。

架构的整体理解与工程要点

把上述五个部分串起来看，轨迹跟踪的基本架构可以概括为一条“参考—误差—控制—动力学—反馈”的闭环链路。参考轨迹生成提供目标，误差定义把目标与实际状态的差距量化，前馈补偿提供标称控制量，反馈控制回路修正残差，闭环稳定性则保证整个系统在扰动下仍然收敛。这五个环节缺一不可：没有前馈，反馈会滞后；没有反馈，初始偏差和扰动无法消除；没有稳定性分析，增益选取就是盲目的。

在实际工程实现中，还有几个容易被忽视的细节。第一，参考轨迹的采样率必须与控制周期匹配，否则前馈量会在时间上错位，反而引入额外误差。第二，误差定义中的速度项通常来自导航滤波器的估计，估计延迟会等效为相位滞后，压缩稳定裕度，因此高精度跟踪任务中需要把导航延迟纳入稳定性分析。第三，前馈模型不必追求完全精确，剩余部分由反馈承担即可，但前馈误差过大会导致反馈长期工作在较大输出状态，容易触发饱和。第四，增益调度是常用手段：在误差较大时降低增益避免饱和，在误差较小时提高增益加快收敛。

总结来说，轨迹跟踪的基本架构不是简单的“误差反馈”，而是前馈与反馈的协同。前馈让系统“知道该往哪走”，反馈让系统“走偏了能回来”，稳定性分析则保证“回来”的过程是收敛而非振荡的。掌握这个架构，后续学习具体的制导律设计（如比例导引、滑模控制、模型预测控制）时，就能清楚地知道每种方法在架构中替代或强化了哪个环节。