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

姿态描述是姿控系统集成中最基础也最容易出问题的一环。姿态本身是刚体相对某一参考基准的角位置关系,但“相对谁、按什么顺序转、用什么数学量表示、接口上按什么字节序传”这四个问题如果不统一,后续的控制器、敏感器、执行机构和地面测试系统就会各说各话。本节围绕参考坐标系、方向余弦阵、四元数和欧拉角四类对象,说明它们的定义、相互关系以及在集成接口中的表示与转换方法。

一、参考坐标系:先定义“相对谁”

航天器姿态必须相对明确的参考系描述。工程中常用的有:地心惯性系(ECI,如J2000),用于轨道与惯性敏感器解算;轨道坐标系(如VVLH或RSW),其原点在航天器质心,常用于对地定向任务;本体坐标系(Body),固连于星体,其轴向由结构安装基准确定;此外还有敏感器坐标系、执行机构坐标系和太阳/目标视线坐标系等。

集成接口中必须明确每个坐标系的轴向定义、原点位置和转换关系。例如某型号卫星定义本体坐标系:+X为飞行方向,+Z指向地心,+Y按右手定则补全。若星上某星敏感器安装矩阵为R_bs,则其测量输出需先经该矩阵转到本体系,再参与姿态确定。坐标系定义一旦在接口控制文件中冻结,所有分系统必须严格一致,任何“临时调整轴向”都会导致姿态解算符号错误。

建议在接口控制文件中为每个坐标系记录:名称、原点、三轴指向、右手/左手、单位、与父坐标系的转换矩阵或四元数、有效范围。这是后续所有转换的基准。

二、方向余弦阵:最直观的旋转表示

方向余弦阵(DCM)是一个3×3正交矩阵,其元素为两个坐标系各轴之间的方向余弦。若C_ba表示从a系到b系的旋转,则矢量满足v_b = C_ba · v_a。DCM的优点是物理意义明确、矢量变换直接;缺点是9个元素存在6个约束,数值积分时需正交化,且存储和传输开销较大。

在集成中,DCM常用于地面测试和星上矩阵运算。例如由欧拉角(φ, θ, ψ)按Z-Y-X顺序构造本体系相对轨道系的DCM,可写为C_bo = Rz(ψ)·Ry(θ)·Rx(φ)。实际代码中通常直接展开为9个元素,避免重复三角函数计算。需要注意:不同旋转顺序得到的DCM不同,接口中必须注明顺序约定。

三、四元数:星上姿态传播的首选

四元数用4个参数q = [q0, q1, q2, q3](或[qw, qx, qy, qz])表示旋转,其中q0为标量部分。单位四元数满足q0²+q1²+q2²+q3²=1。其运动学方程为q̇ = 0.5 · q ⊗ ω,其中ω为本体系角速度,⊗为四元数乘法。四元数无奇异、传播稳定、计算量小,是星上姿态确定与控制的默认表示。

集成接口中四元数需明确:标量在前还是在后、是否单位化、符号约定(q与-q表示同一姿态)、更新周期和归一化策略。例如某星上软件约定q = [q0, q1, q2, q3],标量在前,每周期用q = q / ||q||归一化。若地面测试系统按[qx, qy, qz, qw]解析,就会出现姿态翻转或跳变,这是集成联调中非常典型的故障。

四、欧拉角:最易读但最需谨慎

欧拉角用三个角度描述姿态,常见顺序有Z-Y-X(偏航-俯仰-滚转)、Z-X-Z等。其优点是直观、便于操作人员理解;缺点是存在万向节锁,且同一姿态在不同顺序下角度不同。集成中欧拉角多用于人机界面、任务规划和地面显示,星上内部通常转换为四元数或DCM。

以Z-Y-X顺序为例,从本体系到轨道系的欧拉角(ψ, θ, φ)与四元数的转换关系为:

q0 = cos(φ/2)cos(θ/2)cos(ψ/2) + sin(φ/2)sin(θ/2)sin(ψ/2)
q1 = sin(φ/2)cos(θ/2)cos(ψ/2) - cos(φ/2)sin(θ/2)sin(ψ/2)
q2 = cos(φ/2)sin(θ/2)cos(ψ/2) + sin(φ/2)cos(θ/2)sin(ψ/2)
q3 = cos(φ/2)cos(θ/2)sin(ψ/2) - sin(φ/2)sin(θ/2)cos(ψ/2)

反向转换时,需注意θ = ±90°附近的奇异处理。工程上通常设置阈值,当|sin θ|接近1时改用其他表示或直接保持四元数,避免欧拉角解算溢出。

五、集成接口中的表示与转换

在姿控系统集成中,姿态数据的流转通常遵循“敏感器原始测量→本体系矢量→姿态确定→四元数→控制律→执行机构指令”的链路。接口设计需明确每个环节的表示形式、单位、更新率和坐标系。例如星敏感器输出本体系相对惯性系的四元数,陀螺输出本体系角速度,姿态确定模块融合后输出本体系相对轨道系的四元数,控制律再据此计算力矩指令。

转换过程中,必须保持参照系一致。若需从惯性系转到轨道系,应先由轨道参数计算轨道系相对惯性系的四元数q_oi,再与星上姿态四元数q_bi做四元数乘法得到q_bo = q_bi ⊗ q_oi⁻¹。注意乘法顺序和逆的定义,不同文献可能采用不同约定,集成时必须统一。

姿态描述与集成接口转换链路 参考坐标系 惯性系 ECI (J2000) 轨道系 VVLH 本体系 Body 敏感器系 Sensor 执行机构系 姿态表示 方向余弦阵 DCM 3×3 正交矩阵 · 9元素 四元数 Quaternion 4参数 · 无奇异 · 星上首选 欧拉角 Euler 3角度 · 直观 · 有奇异 旋转矩阵 R 安装矩阵 · 固定 ⇄ ⇄ ⇄ 集成接口表示与转换 数据格式约定 标量前后 · 单位 · 字节序 坐标系转换链 q_bo = q_bi ⊗ q_oi⁻¹ 更新率与归一化 周期 · 阈值 · 奇异处理 敏感器测量 → 本体系矢量 → 姿态确定 → 四元数 → 控制律 → 执行机构指令 接口一致性检查:坐标系定义 · 四元数符号 · 欧拉角顺序 · 单位与量纲 ⚠ 常见故障:四元数标量位置不一致 · 欧拉角顺序混淆 · 坐标系轴向定义冲突

六、集成中的典型问题与检查要点

姿态表示与转换在集成联调中常出现三类问题。第一类是四元数标量位置不一致,导致姿态符号翻转或跳变;第二类是欧拉角旋转顺序混淆,例如星上按Z-Y-X计算,地面按Z-X-Z显示,结果完全不符;第三类是坐标系轴向定义冲突,例如某敏感器安装矩阵未按接口文件更新,导致姿态解算偏差。

为避免这些问题,建议在集成前完成以下检查:确认所有分系统的坐标系定义与接口控制文件一致;确认四元数标量位置、符号约定和归一化策略统一;确认欧拉角顺序和奇异处理方式一致;确认转换矩阵的乘法顺序和逆的定义一致;在联调中设置姿态注入测试,用已知姿态验证全链路转换正确性。

姿态描述与转换是姿控系统集成的“语言基础”。只有所有分系统在坐标系、表示形式和转换规则上完全一致,后续的控制器设计、性能评估和故障排查才有可靠前提。