2. 姿态描述与运动学基础

姿态控制故障诊断的第一步，不是去调控制器，而是把“航天器当前是什么姿态、姿态怎么变化”用一套无歧义、可计算、可比较的数学语言表达出来。方向余弦矩阵、欧拉角、四元数和姿态运动学方程，正是这套语言的四个层次：矩阵描述“两个坐标系之间的旋转关系”，欧拉角给出“人可读的三次转动”，四元数提供“无奇异、可插值、适合递推”的紧凑表示，运动学方程则把角速度与姿态参数的变化率联系起来。故障诊断中，姿态参数既是观测量，也是残差构造的基准量，因此必须清楚每种表示的适用边界。

一、方向余弦矩阵：姿态的几何本体

设本体系 b 相对参考系 n 的姿态用方向余弦矩阵 C_bn 表示，其元素为两坐标系各轴单位矢量的点积。约定 C_bn 把 n 系矢量变换到 b 系，即 v^b = C_bn vⁿ。该矩阵是正交阵，满足 C^TC = I、det(C) = +1，共 9 个元素但只有 3 个自由度，因此存在 6 个约束。故障诊断中，方向余弦矩阵常用于：由星敏感器与陀螺组合确定姿态基准；计算姿态误差矩阵 C_err = C_meas C_ref^T，再由其反对称部分提取误差轴与误差角。若某敏感器输出使 C_meas 明显偏离正交性，往往提示安装矩阵错误、标定系数异常或数据关联错误。

二、欧拉角：直观但需约定顺序

欧拉角把姿态分解为绕三个轴的依次转动，例如 3-1-2 顺序（偏航 ψ、滚转 φ、俯仰 θ）。其优点是物理意义直观，便于地面判读和故障定位；缺点是存在万向节锁，当中间角接近 ±90° 时，另两个角耦合，解算病态。工程上必须明确：转序、内旋/外旋、参考系。以 3-1-2 为例，由 C_bn 反解时，θ = arcsin(C₂₃)，φ = atan2(−C₁₃, C₃₃)，ψ = atan2(−C₂₁, C₂₂)。若俯仰角接近 ±90°，atan2 的两个输入同时趋零，欧拉角对噪声极其敏感，此时故障诊断不应直接以欧拉角残差作为唯一判据，而应切换到四元数或矩阵残差。

三、四元数：递推与插值的首选

单位四元数 q = [q₀, q₁, q₂, q₃]^T 满足 q^Tq = 1，用 4 个参数表示 3 个自由度，冗余 1 维但无奇异。姿态运动学方程为：

q̇ = 0.5 * Ω(ω) * q
Ω(ω) = [ 0   -ωx  -ωy  -ωz
         ωx   0    ωz  -ωy
         ωy  -ωz   0    ωx
         ωz   ωy  -ωx   0  ]

其中 ω = [ω_x, ω_y, ω_z]^T 为本体系相对参考系的角速度。数值递推常用一阶或四阶龙格-库塔，并在每步后归一化。故障诊断中，四元数残差 δq = q_meas ⊗ q_ref⁻¹ 的矢量部分可直接映射为小角度误差轴，适合构造陀螺漂移、常值干扰力矩和敏感器慢变故障的检测量。相比欧拉角，四元数在接近奇异姿态时仍能稳定给出误差方向。

四、姿态运动学方程与故障诊断表达

姿态运动学方程把角速度与姿态参数变化率联系起来，本身不含力矩和惯量，因此它描述的是“几何关系”而非“动力学因果”。在故障诊断中，这一区分非常关键：陀螺输出异常、星敏跳变、安装矩阵错误属于运动学层面的故障；而飞轮饱和、推力器失效、惯量辨识偏差属于动力学层面。运动学方程给出的残差，主要用于判断“姿态测量与角速度积分是否自洽”。

一个实用的诊断表达是：用陀螺角速度积分得到预测四元数 q_pred，与星敏解算四元数 q_meas 比较，得到误差角 δθ = 2 arccos(|q_pred^T q_meas|)。若 δθ 持续超过阈值且方向固定，优先怀疑陀螺常值漂移或标定误差；若 δθ 随机跳变，优先怀疑星敏数据有效性或时间同步；若 δθ 随姿态变化呈周期性，则可能是安装矩阵或柔性附件耦合。下表给出常见残差模式与故障假设的对应关系，可作为诊断初筛依据。

五、表示选择与诊断流程

实际工程中，四种表示并非互斥，而是分工使用：方向余弦矩阵用于精确坐标变换和正交性检验；欧拉角用于地面显示和操作员判读；四元数用于星上递推、滤波和残差构造；运动学方程用于建立测量与角速度之间的一致性关系。诊断时，建议先检查四元数归一化误差和方向余弦矩阵正交性，再计算姿态残差，最后根据残差的时间特征选择故障假设。这样可以把“表示层错误”和“敏感器层故障”分开，避免把符号约定问题误判为硬件故障。

把上述关系落到具体数值上，可以更清楚地看到表示层与故障层的分界。假设某时刻星敏解算四元数 q_meas = [0.7071, 0.0, 0.7071, 0.0]^T，陀螺积分预测四元数 q_pred = [0.7069, 0.0012, 0.7071, 0.0003]^T。先检查归一化：两者模长分别为 1.0000 和 1.0000，表示层正常。再计算点积 q_pred^Tq_meas ≈ 0.99999，误差角约 0.01°，在正常噪声范围内。若下一拍 q_meas 突变为 [0.0, 0.7071, 0.0, 0.7071]^T，点积接近 0，误差角接近 180°，但模长仍为 1，说明不是归一化问题，而是姿态解算发生了大跳变，应优先检查星敏数据有效性、时间同步和四元数符号连续性，而不是立即判定陀螺故障。

综上，方向余弦矩阵、欧拉角、四元数和运动学方程共同构成姿态描述与诊断的数学基础。方向余弦矩阵提供几何本体和正交性检验，欧拉角提供直观判读但需警惕奇异，四元数提供无奇异递推和残差构造，运动学方程则建立角速度与姿态变化率之间的一致性关系。故障诊断中，先做表示层一致性检查，再做残差时间特征分析，最后映射到具体故障假设，才能把“姿态表示问题”和“敏感器/执行机构故障”有效区分开。