› 航天器姿态四元数模拟器 返回
航空航天工程

航天器姿态四元数模拟器

航天器、飞行器、机器人的三维姿态表示用的"四元数 q=(w,x,y,z)",从滚转/俯仰/偏航的Euler角与任意轴周围旋转组合,实时计算4个分量、范数、等效Euler角。规避万向锁(Gimbal Lock),采用Hamilton规约的四元数在姿态确定控制系统(ADCS)中被广泛使用。直观学习四元数的几何与物理意义。

参数设置
滚转 φ
°
机体X轴(前后)周围的旋转
俯仰 θ
°
机体Y轴(左右)周围的旋转。±90°出现万向锁
偏航 ψ
°
机体Z轴(上下)周围的旋转
旋转轴 n_x
旋转轴 n_y
旋转轴 n_z
轴向量自动归一化为单位向量
旋转角 α
°
轴-角度四元数的旋转量
计算结果
—
四元数 w
—
四元数 x
—
四元数 y
—
四元数 z
—
范数 |q|
—
合成Euler(φ,θ,ψ)°
—
3D航天器模型 — 姿态与旋转轴可视化

机体按合成姿态 q_total 旋转。粗箭头为机体轴(X=红、Y=绿、Z=蓝),细箭头为惯性轴 X₀Y₀Z₀,虚线箭头为施加轴-角度旋转之前的机体轴(q_euler)。黄色箭头是旋转轴 n,按合成式 q_total = q_euler·q_axis 的要求绘制在 Euler 旋转后的机体坐标系中;黄色圆弧与点线分别表示绕 n 旋转 α 的方向以及机头(X 轴末端)扫过的轨迹。拖动图形可旋转视角,双击(双击触摸)恢复初始视角。

四元数4个分量
α扫描 — 合成Euler角
理论与主要公式

$$q = \cos\tfrac{\alpha}{2} + \sin\tfrac{\alpha}{2}\bigl(n_x\,i + n_y\,j + n_z\,k\bigr),\quad q_1\,q_2 = (\text{rotation composition})$$

单位向量n=(n_x,n_y,n_z)周围旋转角度α的四元数。四元数乘法非可交换(q1·q2≠q2·q1)。

$$q_{ZYX} = \begin{pmatrix} c_r c_p c_y + s_r s_p s_y \\ s_r c_p c_y - c_r s_p s_y \\ c_r s_p c_y + s_r c_p s_y \\ c_r c_p s_y - s_r s_p c_y \end{pmatrix},\quad c_\ast=\cos\tfrac{\ast}{2},\,s_\ast=\sin\tfrac{\ast}{2}$$

Tait-Bryan ZYX顺序(偏航→俯仰→滚转)组合的Euler至四元数变换。φ:滚转、θ:俯仰、ψ:偏航。

$$|q| = \sqrt{w^2 + x^2 + y^2 + z^2} = 1,\qquad q^{-1} = q^* / |q|^2,\qquad q^* = (w,-x,-y,-z)$$

单位四元数条件与逆元(共轭q*)。实际系统在每个控制周期执行q←q/|q|重新归一化。

四元数在航天器姿态表示中的应用

🙋
航天器的姿态不是用滚转、俯仰、偏航3个角度就能确定吗?为什么要用4分量的四元数呢?多一个分量是不是浪费?
🎓
提得好。虽然自由度确实是3个,Euler角也能描述姿态,但实用中有个致命问题叫"万向锁"。当俯仰恰好是±90°时,滚转和偏航轴会重合,两者无法区分。阿波罗飞船的惯性平台采用三框架万向架,因此飞行中乘员必须注意避免接近万向锁姿态。四元数多一维,物理上消除了这个特异点。
🙋
明白了,特异点规避最重要。但四元数看起来像复数的推广,有i²=−1这样的东西,感觉很复杂…它到底表示什么啊?
🎓
简单说,q=(cos(α/2), sin(α/2)·n)就是"绕轴n旋转角度α"这个操作的数值表示。半角α/2会让人一开始很困惑,但这是因为四元数作用在向量v上时用的是v'=q·v·q*这种"左右夹持"的形式。两边都作用,所以旋转角被加倍,必须用半角补偿。因此q和−q表示同一个旋转,叫"二重覆盖"。在左侧把滚转、俯仰、偏航都设为0,再设"旋转轴=(0,0,1)、旋转角=90°",显示的q=(cos45°, 0, 0, sin45°)=(0.7071, 0, 0, 0.7071),合成偏航为90°(工具显示的是合成q_total,要单看q_axis需把Euler角设为0)。
🙋
两个旋转合成时用"乘法",对吧。这和普通乘法不一样?
🎓
完全不同。四元数乘法是Hamilton在1843年发现的非可交换代数,q1·q2≠q2·q1。旋转顺序改变的话结果就不一样,和现实中旋转操作一样。本工具里用"Euler角合成的姿态四元数q_euler"乘以"轴-角度的q_axis",得到总姿态。比如从星敏感器读来的绝对姿态,再加上反应轮的差分旋转,就这样用乘法合成。四元数SLAM、姿态推定的扩展卡尔曼滤波(EKF/UKF)都用这个乘法写状态转移。
🙋
右上的"范数|q|"要验证等于1,不然会怎样?
🎓
单位四元数|q|=1才表示纯旋转。如果|q|=1.05,就混进了5%的放大变换。实际的姿态确定系统通常在每个控制周期做q←q/|q|重新归一化,或用误差四元数定式化(multiplicative EKF, MEKF)来抑制误差积累。用角速度数值积分姿态时,无论哪种积分法,舍入和截断误差都会使范数慢慢偏离1,长时间运行必须补偿。
🙋
下面的"α扫描"图表显示,当α增大时有的地方Pitch突然跳变…这也是万向锁?
🎓
观察敏锐!那是Euler角反向变换独有的问题——"pitch=±90°附近atan2的分母接近0,滚转与偏航互换"。四元数侧完全没问题,4个分量光滑变化。这正是"在四元数域做积分,只在显示时转换为Euler角"的理由。

常见问题

四元数用4个分量(w,x,y,z)一一对应地表示3D旋转,能完全规避Euler角的特异点万向锁(俯仰±90°时滚转与偏航退化的现象)。此外,两次旋转的复合只需一次乘法,插值(SLERP)在四元数域内等角速度光滑,因此在姿态确定控制系统(ADCS)、星敏感器、MEMS IMU融合、机器人臂轨迹规划等连续处理姿态的场景中被广泛采用。
Tait-Bryan ZYX顺序(偏航→俯仰→滚转)中,设cy=cos(ψ/2), sy=sin(ψ/2), cp=cos(θ/2), sp=sin(θ/2), cr=cos(φ/2), sr=sin(φ/2),则q_w=cr·cp·cy+sr·sp·sy, q_x=sr·cp·cy−cr·sp·sy, q_y=cr·sp·cy+sr·cp·sy, q_z=cr·cp·sy−sr·sp·cy。其中φ=滚转、θ=俯仰、ψ=偏航。符号规约有Hamilton(i²=j²=k²=ijk=−1)与JPL两种,本工具遵循Hamilton规约实现。
单位四元数|q|=1才能表示纯旋转。数值积分或传感器融合(扩展卡尔曼滤波)时随着时间推移范数偏离1,转换为旋转矩阵后会混入缩放分量,导致向量长度改变。本工具在|q|−1|>0.01时给出警告。实际ADCS系统在每个控制周期执行q←q/|q|重新归一化,或采用误差四元数定式化来抑制误差积累。
单位向量n=(n_x,n_y,n_z)周围旋转角度α的四元数为q=(cos(α/2), sin(α/2)·n_x, sin(α/2)·n_y, sin(α/2)·n_z)。物理含义直观,与Rodrigues旋转公式直接对应。半角α/2的出现是因为四元数作用在向量v上遵循v'=q·v·q*的"夹持"形式,两侧都有作用,所以需要半角补偿。由此产生q与−q表示同一旋转的"二重覆盖"性质。

实际应用

航天器与人工卫星姿态确定控制系统(ADCS):人造卫星与探测器的姿态推定与控制通常以四元数作为内部表示。从星敏感器获得绝对姿态四元数q_ref,用陀螺仪角速度按q̇=½·q·ω积分,通过误差四元数δq向反应轮或推进器下指令。显示时才转为Euler角,计算全部在四元数域进行。

无人机与UAV姿态控制:许多无人机飞行控制器用互补滤波或MEKF融合MEMS IMU(加速度计+陀螺+磁传感器)数据,内部状态储存四元数。垂直上升到背飞的急剧机动,Euler角在俯仰±90°处会破坏,四元数基础则完全平滑无特异点。

3DCG、游戏引擎、VR/AR:多数实时3D应用的Transform旋转用四元数储存。关键帧补间用SLERP(球面线性插值)实现等角速度平滑旋转。VR头显的6自由度追踪输出的姿态同样以四元数处理,渲染管线最后才变为视图矩阵。

机器人工程与动作捕捉:工业机器臂轨迹规划、人形机器人平衡控制、动作捕捉的刚体姿态输出等,只要涉及关节角或刚体姿态的补间、求导,都优先选四元数规避Euler角特异点。逆运动学雅可比计算中旋转自由度按3处理时,四元数切空间(角速度向量)也是标准过程。

常见误区与注意事项

最大的混淆来自四元数"符号规约"的存在。Hamilton规约(ij=k)与JPL规约(ij=−k)两种并存,两者的四元数乘法符号相反。3DCG、游戏领域多用Hamilton,JPL规约顾名思义见于JPL系文献,混用不同规约的库会导致姿态反向旋转。本工具采用Hamilton规约。再者存储顺序也有(w,x,y,z)与(x,y,z,w)之分,各库不同,教科书与本工具用前者。移植代码时务必两个都查。

其次"四元数无特异点"常被误解为"逆变换也无特异点"。四元数q在4维单位球面S³上光滑分布确实无特异点,但q到Euler角的逆变换用asin、atan2,在俯仰=±90°时出现atan2(0,0)不定域,滚转与偏航交换。本工具在pitchOut计算中对|sinp|≥1做钳位,并在恰为±90°时把滚转记为0、将整体朝向归入偏航显示,就是这个原因。所以设计原则才是"姿态积分与控制在四元数域,显示时才变Euler角"。

最后"单位四元数一直保持"的假设会出错。用角速度数值积分姿态时,无论哪种积分法,舍入和截断误差都会使范数慢慢偏离1,不修正的话姿态推定会有偏差。实机要么每周期执行q←q/|q|,要么用误差四元数定式化(MEKF)把误差当小量在0附近处理。本工具从Euler角与轴-角度闭式计算,显示的范数在6位小数内始终为1.000000,但长积分系统一定要加归一化。

使用指南

  1. 输入Roll、Pitch、Yaw(单位度),或指定旋转轴向量(X/Y/Z分量)和旋转角度
  2. 模拟器自动从Euler角转换为四元数(w,x,y,z),验证范数|q|
  3. 查看输出四元数值与合成Euler角,观察万向锁现象(俯仰90°附近)特性
  4. 对比轴-角度表示的计算结果,理解SLERP补间的基础

具体计算例

输入Roll=30°、Pitch=45°、Yaw=60°,并把旋转角α设为0°(轴-角度部分为恒等),工具显示q=(0.8224, 0.0223, 0.4397, 0.3604),范数|q|=1.000000,合成Euler角φ=30.0°、θ=45.0°、ψ=60.0°与输入一致。w可手算验证:cos15°·cos22.5°·cos30° + sin15°·sin22.5°·sin30° = 0.7728 + 0.0495 = 0.8224。再做一个检算:Roll=30°、Pitch=0°、Yaw=0°、旋转轴(1,0,0)、α=30°,得到q=(0.8660, 0.5000, 0, 0),合成滚转为60.0°,说明绕同一轴的两次旋转角度相加。

工程实践注意