3. 姿态运动学方程

姿态运动学方程描述的是“姿态参数如何随角速度变化”，它不涉及力矩与惯量，只回答一个核心问题：给定本体系下的角速度 ω，描述姿态的三个或四个参数怎样随时间演化。工程上最常用的两套参数是欧拉角与四元数，它们各自对应一组运动学微分方程，也各自带着不同的奇异性与计算代价。理解这两套方程的结构差异，是后续指向控制中“选哪套参数、在什么环节切换”的前提。

一、欧拉角运动学：直观但有奇异点

以航天器姿态控制中最常见的 3-1-2（偏航-滚动-俯仰）或 3-2-1（偏航-俯仰-滚动）转序为例，设欧拉角为 φ（滚动）、θ（俯仰）、ψ（偏航），本体系角速度为 ω=[ω_x, ω_y, ω_z]^T。对 3-2-1 转序，欧拉角速率与角速度的关系为：

[φ̇]   [1  sinφ·tanθ   cosφ·tanθ] [ω_x]
[θ̇] = [0     cosφ        -sinφ   ] [ω_y]
[ψ̇]   [0  sinφ/cosθ   cosφ/cosθ ] [ω_z]

这个矩阵把本体系角速度映射为欧拉角变化率。它的价值在于直观：φ、θ、ψ 直接对应滚动、俯仰、偏航三个物理通道，便于操作人员理解与显示。但矩阵中出现了 tanθ 与 1/cosθ，当俯仰角 θ→±90° 时，这两个元素趋于无穷，方程失效，这就是欧拉角运动学的奇异点（也称万向节死锁）。在奇异点附近，即使角速度有限，欧拉角速率也可能急剧放大，数值积分会迅速发散。

需要强调的是，奇异点不是物理上的姿态不可达，而是参数化本身的缺陷。航天器完全可以指向 θ=90° 的姿态，只是用这组欧拉角无法平滑地描述其邻域运动。因此欧拉角适合用于小角度或中等角度机动、姿态显示与地面判读，不适合作为大角度连续机动的唯一积分变量。

二、四元数运动学：无奇异但需归一化

四元数用四个参数 q=[q₀, q₁, q₂, q₃]^T 描述姿态，其中 q₀ 为标量部分，[q₁,q₂,q₃] 为矢量部分，满足约束 q₀²+q₁²+q₂²+q₃²=1。其运动学方程为：

q̇ = 0.5 · q ⊗ [0, ω_x, ω_y, ω_z]

展开为：
[q̇0]   [ 0   -ω_x  -ω_y  -ω_z] [q0]
[q̇1] = [ω_x    0    ω_z  -ω_y] [q1] · 0.5
[q̇2]   [ω_y  -ω_z    0    ω_x] [q2]
[q̇3]   [ω_z   ω_y  -ω_x    0 ] [q3]

该方程是双线性形式，对任意姿态、任意角速度都成立，不存在奇异点。这是四元数在姿态确定与控制系统中最被青睐的根本原因。代价有两点：一是四个参数描述三维姿态，存在冗余，数值积分后必须重新归一化，否则范数漂移会引入姿态误差；二是 q 与 -q 表示同一姿态，在姿态误差计算与符号选择时需要处理“双覆盖”问题。

实际实现中，常用四阶龙格-库塔法以固定步长积分 q̇，每步后执行 q←q/‖q‖。例如采样周期 0.01 s、角速度约 0.5°/s 的慢速指向任务，单步归一化即可把范数误差控制在 10^-12 量级；而在 5°/s 以上的快速机动中，建议采用 0.005 s 或更小步长，并在机动段加密归一化。

三、奇异性分析：从参数到控制的映射

欧拉角奇异性的本质是“三参数描述三维旋转”的拓扑必然：任何三个参数的全局姿态描述都至少存在一个奇异构型。四元数用四个参数换来了全局无奇异，但引入了归一化约束与双覆盖。工程上判断是否“踩到奇异”，不能只看 θ 是否等于 90°，而应关注奇异邻域内的角速率放大倍数。以 3-2-1 转序为例，当 θ=85° 时，tanθ≈11.43，1/cosθ≈11.47，意味着同样的本体系角速度会被放大十余倍映射到欧拉角速率上。若控制周期为 0.01 s，单步欧拉角增量可能超过 1°，线性化误差与积分误差都会显著上升。

因此，奇异性分析应给出两个实用判据：其一，当前俯仰角与 ±90° 的余量是否小于设定阈值（如 5°）；其二，欧拉角速率矩阵的条件数是否超过阈值（如 20）。任一条件触发，就应切换到四元数积分或采用奇异鲁棒算法。

四、在指向控制中的选用原则

指向控制的目标是让航天器某轴（如相机光轴、天线波束轴）对准目标方向，其误差通常以目标矢量与本体系指向轴的夹角衡量。选用运动学参数时，应遵循以下原则。

• 积分变量优先用四元数。姿态确定滤波器（如扩展卡尔曼滤波）与姿态控制律内部统一采用四元数积分，避免在大角度机动或接近奇异时出现数值发散。四元数误差常用 q_e=q_c^-1⊗q_t 计算，并取标量部分非负的分支。
• 显示与操作界面用欧拉角。地面判读、遥测显示、操作人员输入目标姿态时，欧拉角更符合直觉。可在四元数积分的同时，按需将 q 转换为 3-2-1 欧拉角用于显示，转换只在输出端进行，不参与积分。
• 奇异邻域主动切换。当俯仰角余量小于 5° 或欧拉角速率矩阵条件数大于 20 时，禁止用欧拉角方程积分，改用四元数；若控制律本身基于欧拉角设计，应引入奇异鲁棒项或改用四元数误差反馈。
• 归一化不可省略。四元数每步积分后必须归一化，否则范数漂移会等效为姿态误差。建议在控制周期内至少归一化一次，快速机动段可每步归一化。
• 双覆盖处理要一致。q 与 -q 表示同一姿态，在误差计算、符号选择、插值中必须统一约定，避免控制指令在 q 与 -q 之间跳变导致执行机构抖动。

综上，欧拉角运动学与四元数运动学不是互相替代的关系，而是分工关系：四元数负责“算得稳”，欧拉角负责“看得懂”。在指向控制中，把积分、误差计算、控制律放在四元数域，把显示、目标输入、奇异监控放在欧拉角域，并在奇异邻域主动切换，是兼顾精度、鲁棒性与工程可操作性的合理方案。