2. 航天器姿态动力学与控制基础回顾

半实物验证的第一步，不是接电缆、不是跑仿真，而是把“被控对象”在计算机里立起来。这个被控对象就是航天器姿态运动模型：它要能接受执行机构给出的力矩，输出敏感器能“看到”的姿态量，并且中间的运动规律必须与真实航天器一致。本节把姿态描述、运动学方程、动力学方程、敏感器与执行机构的作用机理串成一条完整的建模链路，为后续半实物闭环打下基础。

一、姿态描述：三组常用参数与它们的适用场合

姿态描述解决的是“航天器本体相对参考系的朝向如何用数字表达”。工程上最常用的有三组：欧拉角、方向余弦矩阵和四元数。

欧拉角最直观，例如按 3-1-2 顺序（偏航 ψ、滚转 φ、俯仰 θ）旋转，得到本体相对参考系的姿态。它的优点是物理意义明确，便于操作人员判读；缺点是存在奇异点，当俯仰角接近 ±90° 时，偏航与滚转无法区分，运动学方程出现除零。因此欧拉角适合小角度或中等角度下的显示与判读，不适合作为大角度机动的内部积分变量。

方向余弦矩阵 C_b^r 用 3×3 正交矩阵描述两个坐标系之间的投影关系，无奇异，但需要维护 9 个元素并满足正交约束，数值积分时容易漂移，通常用于坐标变换而非直接积分。

四元数 q = [q0, q1, q2, q3]^T 用 4 个参数描述姿态，满足 q0²+q1²+q2²+q3²=1，无奇异、计算量小，是姿态确定与控制系统内部积分和滤波的首选。半实物验证中，仿真机内部一般用四元数积分，对外显示和遥测再转成欧拉角。

二、运动学方程：姿态参数如何随时间演化

运动学方程只关心姿态参数与角速度的关系，不涉及力和力矩。以四元数为例，若本体相对参考系的角速度在本体系下为 ω = [ωx, ωy, ωz]^T，则四元数运动学方程为：

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

实际实现时，仿真步长 Δt 通常取 1 ms～10 ms，采用四阶龙格-库塔或二阶龙格-库塔积分，并在每步后对四元数做归一化，抑制数值漂移。若用欧拉角，则运动学方程含 1/cosθ 项，θ 接近 90° 时数值发散，这也是半实物仿真内部不直接用欧拉角积分的原因。

三、动力学方程：力矩如何改变角速度

动力学方程描述力矩与角速度变化的关系。在本体坐标系下，刚体航天器的欧拉动力学方程为：

I · ω̇ + ω × (I · ω) = T
I = diag(Ix, Iy, Iz)   （主轴惯量，示例值：Ix=120, Iy=150, Iz=100 kg·m²）
T = T_ctrl + T_dist + T_env

其中 T_ctrl 为执行机构产生的控制力矩，T_dist 为干扰力矩（如太阳光压、气动、剩磁），T_env 为环境力矩。展开后可见，即使没有外力矩，只要存在 ω × (I·ω) 陀螺耦合项，三轴角速度也会相互耦合，这正是姿态动力学区别于一般刚体转动的关键。

半实物验证中，动力学模型通常以“力矩输入—角速度输出”的形式封装成实时模块，运行在仿真机或实时目标机上，步长与敏感器、执行机构接口周期匹配。惯量参数、质心位置、挠性附件模态等来自总体设计数据，示例值仅用于教学演示，实际项目须以设计输入为准。

四、敏感器与执行机构：闭环两端的物理机理

姿态敏感器负责“感知”。星敏感器输出惯性系下的姿态四元数，精度可达角秒级，但更新率较低（典型 1～10 Hz），且易受太阳、地球遮挡影响；陀螺输出本体系角速度，短期精度高、更新率高（典型 10～100 Hz），但存在常值漂移和随机游走；太阳敏感器、磁强计提供低精度辅助观测。半实物验证中，敏感器模型要模拟量测噪声、偏置、量化、更新周期和遮挡逻辑，否则闭环性能会被高估。

执行机构负责“动作”。动量轮通过改变轮子角动量输出反作用力矩，适合连续精细控制，但存在饱和；磁力矩器利用地磁场产生力矩，适合低轨卸载，力矩小、依赖轨道位置；推力器提供大推力脉冲，适合大角度机动和卸载，但消耗工质、力矩不连续。半实物验证中，执行机构模型要包含力矩饱和、死区、响应延迟、轮速限幅和卸载逻辑。

把敏感器、动力学、执行机构按真实信号方向连起来，就得到半实物验证的被控对象闭环。下图给出这一信号链与各环节的关键参数。

五、建模时最容易出错的几个细节

第一，单位与符号。角速度用 rad/s，力矩用 N·m，惯量用 kg·m²，四元数顺序统一为 [q0, q1, q2, q3]（标量在前）。半实物接口若用 [q1, q2, q3, q0]，必须显式转换，否则闭环会发散。

第二，采样周期匹配。敏感器更新率、执行机构指令周期、动力学积分步长三者不一致时，必须做零阶保持或插值，并在接口处明确标注。典型配置：动力学 1 ms，陀螺 10 ms，星敏 100 ms，控制周期 20 ms。

第三，饱和与限幅。动量轮最大力矩、最大轮速，推力器最小脉冲宽度，磁力矩器最大磁矩，都要在模型里体现。否则仿真中控制器会“以为”自己还能继续加力矩，实际早已饱和。

第四，初始条件与对齐。半实物开始前，仿真机内部四元数、陀螺偏置、轮速初值必须与真实设备状态对齐，通常通过“状态注入”或“复位”流程完成。对齐误差会直接表现为闭环初期的姿态误差尖峰。

把上述模型按信号链封装成实时模块，并完成接口对齐后，就得到了半实物验证的“被控对象”。下一阶段的工作，是把真实敏感器、真实执行机构或它们的等效器接入这条链路，用真实物理信号替代模型输出，从而暴露纯数字仿真无法发现的时序、饱和、噪声与故障问题。