2. 姿轨联合控制的对象与坐标系
姿轨联合控制的第一步,不是写控制器,而是把“被控对象”和“描述它的语言”定义清楚。被控对象是航天器本体,它在空间中同时具有平动和转动,共六个自由度;描述它的语言则是若干套坐标系以及它们之间的转换关系。如果对象边界含糊、坐标系约定不统一,后续的动力学方程、敏感器测量、执行机构指令都会出现符号错乱,甚至导致控制方向相反。本节围绕六自由度运动描述、常用坐标系定义与转换、姿轨耦合的物理来源与数学表征三条线索展开。
一、六自由度运动描述:把平动与转动放在同一对象上
航天器的六自由度指三个平动自由度和三个转动自由度。平动通常用质心位置矢量 r 描述,转动用姿态参数描述。工程上最常用的姿态参数是四元数 q = [q0, q1, q2, q3]^T,其中 q0 为标量部分,满足 q0² + q1² + q2² + q3² = 1。相比欧拉角,四元数没有万向节死锁,适合大角度机动和连续积分;欧拉角则直观,便于人机交互和任务规划,但需注意旋转顺序,例如 3-1-2 与 3-2-1 得到的姿态完全不同。
完整的状态量可写为 X = [r^T, v^T, q^T, ω^T]^T,其中 v 为质心速度,ω 为本体角速度。平动动力学在惯性系下由牛顿第二定律给出,转动动力学在本体系下由欧拉方程给出。二者看似独立,但通过质量特性、推力作用点和环境力,会彼此渗透,这正是下一节要讨论的耦合。
二、常用坐标系:定义、原点与轴向约定
姿轨联合控制中至少涉及四类坐标系,必须逐一定义原点、轴向和参照对象。
- 惯性坐标系(ECI):原点在地心,X 轴指向春分点,Z 轴沿地球自转轴指向北极,Y 轴按右手定则确定。它近似惯性,适合描述轨道运动和姿态的绝对指向。
- 轨道坐标系(LVLH):原点在航天器质心,Z 轴指向地心,X 轴沿轨道速度方向,Y 轴垂直轨道面。它随轨道运动旋转,是相对轨道运动和对地指向控制的自然参考。
- 本体坐标系(Body):原点在航天器质心,三轴与星体主惯量轴对齐,X 轴通常为飞行方向,Z 轴为对地方向。敏感器和执行机构的安装矩阵都相对本体系定义。
- 敏感器/执行机构坐标系:如星敏感器坐标系、陀螺坐标系、推力器坐标系,各自有安装偏差,需要通过安装矩阵统一到本体系。
坐标系之间的转换用方向余弦矩阵或四元数完成。若从惯性系到本体系的姿态四元数为 q_bi,则本体系矢量 v_b 与惯性系矢量 v_i 满足 v_b = C(q_bi) v_i。轨道系到本体系的转换则同时包含姿态和轨道位置信息,是姿轨联合控制中最常出现的复合变换。
三、姿轨耦合的物理来源
姿轨耦合不是数学上的巧合,而是有明确物理来源的。第一类是推力偏心与安装偏差:推力器产生的力若不过质心,就会同时产生力矩,轨道机动必然带来姿态扰动。第二类是环境力矩与轨道位置的关联:重力梯度力矩随轨道高度和姿态变化,气动力矩随大气密度和迎风面积变化,太阳光压力矩随光照方向和帆板转角变化,这些力矩既影响姿态,又通过姿态改变迎风/迎光面积反过来影响轨道衰减。第三类是姿态旋转对推力方向的影响:本体系推力方向在惯性系中的投影由姿态决定,姿态偏差会直接改变轨道机动的方向效率。
在数学上,耦合体现在动力学方程的交叉项中。平动方程在惯性系下为 m dv/dt = F_total,其中 F_total 包含本体系推力经姿态矩阵转换后的分量;转动方程在本体系下为 J dω/dt + ω × (Jω) = T_total,其中 T_total 包含推力偏心产生的力矩。若把状态量写成 X = [r, v, q, ω],则系统矩阵会出现姿态相关的非对角块,这就是耦合的数学表征。
v_b = C(q_bi) v_i。若采用相反定义,所有转换矩阵需转置,符号也会变化。工程实现中必须在接口文档中明确写出这一约定,避免敏感器与控制器之间出现“反向控制”。
四、一个可复现的耦合观察示例
为便于理解,给出一个教学示例(参数为合理假设,非实测数据)。设航天器质量 m = 500 kg,主惯量 J = diag(200, 250, 180) kg·m²,质心到推力器作用线偏心 d = 0.05 m。沿本体系 X 轴施加 F = 10 N 的推力,持续 10 s。平动加速度约 0.02 m/s²,10 s 后速度增量约 0.2 m/s;同时产生绕 Y 轴力矩 T = F·d = 0.5 N·m,角加速度约 0.002 rad/s²,10 s 后姿态角变化约 0.1 rad(约 5.7°)。这个量级说明:短时轨道机动中,姿态扰动不可忽略,必须在控制律中同时处理。
观察与判断方法:在仿真或测试中,同时记录 r、v、q、ω 四条曲线。若 v 沿预期方向增长,而 q 出现明显漂移,则说明推力偏心引起的耦合已显现;若 q 漂移方向与偏心方向一致,可确认耦合来源。此时可通过调整推力器安装角、增加姿控补偿力矩或采用姿轨联合控制律来抑制。
五、坐标系转换的工程实现要点
实际实现中,坐标系转换通常按以下顺序组织:先由星敏感器和陀螺确定本体系相对惯性系的姿态 q_bi;再由轨道递推得到轨道系相对惯性系的姿态 q_oi;两者复合得到本体系相对轨道系的姿态 q_bo = q_bi ⊗ q_oi⁻¹。控制律若在轨道系设计,需把测量和指令统一到轨道系;若在本体系设计,则直接使用 q_bi 和 ω。无论哪种方式,安装矩阵 C_sb 和 C_ab 都必须参与转换,否则敏感器测量和执行机构指令会落在错误的轴上。
总结来看,六自由度状态量是对象描述的基础,四类坐标系是空间参照的骨架,姿轨耦合则通过推力偏心、环境力矩和姿态-推力方向关系进入动力学方程。把这三者定义清楚、约定一致,后续的控制器设计、仿真验证和在轨测试才有可靠的共同语言。