2. 姿态描述与坐标系

航天器姿态控制的第一步,是回答“相对于谁、用什么量、怎样描述”这三个问题。姿态本身不是绝对量,它总是两个坐标系之间的相对取向。因此本节先建立三套基本坐标系,再依次介绍方向余弦矩阵、欧拉角、四元数和罗德里格参数四种描述方式,并给出它们之间的转换关系。理解这些工具的分工,是后续设计机动律与指向控制的基础。

一、三套基本坐标系

惯性系是姿态运动的绝对参考。工程上常用 J2000 地心惯性系:原点在地心,X 轴指向 J2000 历元平春分点,Z 轴沿该历元平北极方向,Y 轴按右手法则补齐。它的坐标轴在惯性空间中不随时间转动,因此牛顿角动量方程只在此系中成立,陀螺测量、轨道递推和星敏感器定姿都以它为最终基准。

轨道系随航天器质心沿轨道运动,是姿态指向任务的直接参考。以圆轨道为例,原点取在航天器质心,Z 轴指向地心(对地定向),X 轴沿轨道速度方向,Y 轴垂直于轨道面并与轨道角速度方向一致,构成右手系。对地观测、对日定向、测控天线指向等任务,通常把期望姿态定义在轨道系中,再换算到惯性系。

本体系固连在航天器结构上,原点一般取在质心,三轴与主惯量轴或结构基准轴对齐。星敏感器、陀螺、动量轮、推力器的安装矩阵都相对本体系给出。姿态控制真正要确定和保持的,就是本体系相对参考系(惯性系或轨道系)的取向。

二、方向余弦矩阵

设某矢量在参考系中的分量为 v,在本体系中的分量为 vb,则存在矩阵 Cbi 使 vb = Cbi v。该矩阵的第 i 行第 j 列元素,就是本体系第 i 轴与参考系第 j 轴夹角的余弦,故称方向余弦矩阵。它是正交矩阵,满足 CTC = I,行列式为 +1,逆矩阵等于转置。

方向余弦矩阵的优点是线性、无奇异、可直接对矢量做坐标变换,且连续旋转只需矩阵相乘。缺点是九个元素中只有三个独立,冗余度高,数值积分时正交性会漂移,需要定期重正交化。它常作为其他参数转换的中间桥梁。

三、欧拉角

欧拉角用三次绕坐标轴的转动描述姿态,直观且便于人机交互。航天器姿态常用 3-2-1 顺序:先绕 Z 轴转偏航角 ψ,再绕新 Y 轴转俯仰角 θ,最后绕新 X 轴转滚转角 φ。对应的方向余弦矩阵为

C_bi = R_x(φ) · R_y(θ) · R_z(ψ)

     [ cθcψ            cθsψ           -sθ   ]
   = [ sφsθcψ - cφsψ   sφsθsψ + cφcψ  sφcθ ]
     [ cφsθcψ + sφsψ   cφsθsψ - sφcψ  cφcθ ]

其中 c 表示 cos,s 表示 sin。由矩阵反解欧拉角时,θ = arcsin(−C31),φ 与 ψ 由 C32、C33 和 C21、C11 的反正切给出。当 θ = ±90° 时出现万向节死锁,φ 与 ψ 无法分离,这是欧拉角在大角度机动中的固有缺陷。

四、四元数

四元数用四个参数 q = [q0, q1, q2, q3]T 描述绕单位轴 e 转过角度 Φ 的旋转:q0 = cos(Φ/2),[q1, q2, q3]T = e sin(Φ/2),且满足归一化约束 q02+q12+q22+q32 = 1。它没有奇异点,运动学方程线性,乘法运算量小,是星上姿态确定与控制最常用的表示。

由四元数构造方向余弦矩阵:

C_bi =
[ 1-2(q2²+q3²)   2(q1q2+q0q3)   2(q1q3-q0q2) ]
[ 2(q1q2-q0q3)   1-2(q1²+q3²)   2(q2q3+q0q1) ]
[ 2(q1q3+q0q2)   2(q2q3-q0q1)   1-2(q1²+q2²) ]

注意 q 与 −q 表示同一姿态,这是四元数的双覆盖特性。姿态误差四元数通常取标量部分非负的那一组,以避免控制指令反向。

五、罗德里格参数

罗德里格参数(Gibbs 矢量)定义为 g = e tan(Φ/2),只有三个分量,是四元数矢量部分与标量部分之比。它比四元数少一个参数,且在小角度时近似等于半角矢量,便于线性化分析。缺点是当 Φ 趋近 180° 时 tan(Φ/2) 发散,出现奇异,因此适合中小角度机动或作为误差度量。

由罗德里格参数构造方向余弦矩阵:

C = (I - [g×])⁻¹ (I + [g×])
  = I + 2/(1+gᵀg) · ([g×] + [g×]²)

其中 [g×] 为由 g 构成的反对称矩阵。四元数与罗德里格参数的换算为 g = [q1, q2, q3]T / q0,反向为 q0 = 1/√(1+gᵀg),矢量部分 = g q0。

六、四种描述的对比与选用

描述方式参数个数奇异典型用途
方向余弦矩阵9(约束 6)无坐标变换、矢量投影
欧拉角3θ=±90°人机显示、小角度分析
四元数4(约束 1)无姿态确定、控制律
罗德里格参数3Φ=180°误差度量、线性化
工程惯例:星上姿态确定与滤波用四元数,控制误差用罗德里格参数或误差四元数,地面显示与任务规划用欧拉角,坐标变换统一走方向余弦矩阵。四者之间可无损互转,转换时务必保持旋转顺序与正负号约定一致。
姿态描述参数转换关系图 方向余弦矩阵 C 正交 · 无奇异 · 9 元素 欧拉角 (φ,θ,ψ) 3-2-1 顺序 · θ=±90°奇异 四元数 (q₀,q₁,q₂,q₃) 归一化 · 无奇异 · 双覆盖 罗德里格参数 g 3 分量 · Φ=180°奇异 参考系 惯性系 / 轨道系 / 本体系 R_x R_y R_z q ↔ C g ↔ C C_bi 变换 g = q_vec / q₀ 实线:正向转换 虚线:逆向转换 中心矩阵为各参数互转的公共桥梁

实际使用中,一个典型流程是:星敏感器与陀螺组合定姿,输出本体系相对惯性系的四元数;根据轨道递推得到轨道系相对惯性系的四元数;两者相除得到本体系相对轨道系的姿态误差;将误差转为罗德里格参数送入控制律计算力矩;地面监控界面再把四元数转成欧拉角显示给操作人员。整条链路中,只要约定好旋转顺序、正负号和参考系,四种描述就能无缝衔接。

常见错误:把 3-2-1 与 3-1-3 顺序混用导致矩阵不一致;四元数未归一化使方向余弦矩阵失去正交性;罗德里格参数在接近 180° 机动时数值爆炸。转换前先确认约定,转换后做正交性或归一化校验,是避免姿态解算发散的简单有效手段。