四元数姿态
- 提出者
- William Hamilton (quaternions), aerospace engineers
- 年份
- 1843
- 类型
- Mathematical framework
- 类别
- Representation
本文为机器翻译,尚未经过审校。 阅读英文原文
它有什么作用?
四元数姿态表示是一种使用四维向量(四元数)描述三维旋转的数学框架。它优于欧拉角,因为它消除了奇异点(万向节锁),因此四元数是现代姿态估计、航天器控制和三维计算机图形学中的标准表示。四元数运动学能够优雅地表达姿态如何根据陀螺仪的角速度测量值进行演化。
方法背后的直觉
四元数是一个四元向量 q = [q0, q1, q2, q3] 或 q = [q_标量, q_向量],它表示绕任意轴的旋转。与欧拉角(滚转、俯仰、偏航)不同,欧拉角在某些角度可能变得奇异或模糊,四元数处处光滑。四元数自然地结合了旋转轴和角度;四元数的乘法对应于旋转的组合。
历史学
四元数由威廉·哈密顿于 1843 年发明,作为复数的推广。莱昂哈德·欧拉更早地使用了类似四元数的表示;四元数在 20 世纪被重新发现并应用于刚体动力学。在航空航天领域,在阿波罗计划之后,当航天器姿态确定需要全局无奇异点表示时,四元数成为标准。现代 IMU、游戏引擎和机器人技术都使用四元数。
何时使用
当需要连续、无奇异点的姿态表示时,请使用四元数表示。对于飞行控制系统、惯性测量单元 (IMU) 处理和航天器姿态确定是强制性的。在所有现代导航和控制系统中部署。用于实时姿态传播和传感器融合。由于存在万向节锁风险,请避免在控制回路中使用欧拉角。
局限与注意事项
- 双覆盖;两个四元数(q 和 -q)表示相同的旋转;必须跟踪符号连续性。
- 直观性差;四元数是抽象的;工程师必须将其转换为欧拉角以进行可视化和直观理解。
- 积分中的运动学奇异点;通过 dq/dt = 0.5 q ⊗ ω 进行传播需要仔细的数值积分以维持单位范数。
- 轴-角度解释中的歧义;当角度接近 0 或 2π 时,旋转轴不是唯一的。
来源中的条件不能替代独立的科学审查或分析引擎的验证。
优势
- 无奇异点;四元数避免了万向节锁;姿态可以是任何方向,而不会出现数学故障。
- 计算效率高;四元数乘法比矩阵运算更快;适用于实时控制。
- 归一化表示;单位四元数约束是自然的;无需像旋转矩阵那样进行欧几里得归一化。
- 平滑插值;四元数球面线性插值 (SLERP) 在关键帧之间提供平滑的姿态插值。
应用
- 航天器姿态确定:表示卫星和航天器的方向,无万向节锁。
- 飞机自动驾驶仪和飞行控制:基于四元数的控制律,用于飞机姿态调节和路径跟踪。
- 惯性测量单元 (IMU) 处理:将陀螺仪测量值积分到四元数姿态估计中。
- 三维计算机图形学和游戏引擎:用于动画的平滑旋转表示和插值。
- 机器人技术和自动驾驶汽车:用于导航和运动规划的方向跟踪。
使用方式
使用方式
将姿态表示为四元数 q = [q0, q1, q2, q3],其中 q0 是标量分量,[q1, q2, q3] 是向量部分;确保单位范数 (q0^2 + q1^2 + q2^2 + q3^2 = 1)。
如有需要,对四元数进行归一化;根据显示需要,在表示形式(欧拉角、旋转矩阵)之间进行转换。
使用运动学方程 dq/dt = 0.5 * q ⊗ ω 进行四元数前向传播,其中 ω 是角速度;进行数值积分。
公式
\dot{\vec{q}} = \frac{1}{2}\vec{q} \otimes \vec{\omega}使用来自陀螺仪的新角速度测量值更新四元数;如果融合其他传感器,则应用滤波器(卡尔曼、互补)。
将四元数转换为欧拉角(滚转、俯仰、偏航)以供飞行员显示;直接将四元数用于控制律和动力学;评估姿态置信度。
常见陷阱
- 忘记归一化四元数;数值漂移导致误差累积;周期性归一化至关重要。
- 四元数乘法顺序错误;q1 ⊗ q2 ≠ q2 ⊗ q1(非交换);组合时顺序很重要。
- 混淆四元数共轭与逆;对于单位四元数,逆等于共轭,但这不适用于非单位四元数。
- 在滤波中未处理双覆盖(q 与 -q);如果滤波器不跟踪符号,则会出现不连续性;确保四元数路径连续。
常见问题
四元数与旋转矩阵有何区别?
四元数 q = [q0, q1, q2, q3] 是一个 4 元素表示;旋转矩阵 R 是一个 3x3 正交矩阵。两者都表示相同的旋转。四元数乘法更快(16 次运算 vs. 矩阵乘法的 27 次运算);四元数更紧凑(4 vs. 9 个元素)。它们之间的转换很简单。
为什么 q 和 -q 表示相同的旋转?
单位四元数 q = [cos(θ/2), sin(θ/2) * n] 表示绕轴 n 旋转角度 θ。四元数 -q = [-cos(θ/2), -sin(θ/2) * n] 表示相同的旋转(两者产生相同的旋转矩阵)。这种双覆盖通过保持连续性(避免符号翻转)在滤波中得到处理。
如何积分四元数运动学?
使用 dq/dt = 0.5 * q ⊗ ω_body,其中 ω_body 是机体坐标系中的角速度。使用欧拉法、RK4 或其他积分器进行数值积分。关键:每一步之后重新归一化四元数以维持单位范数 (||q|| = 1)。或者,使用指数映射积分以获得更高的精度。
如何将四元数转换为欧拉角?
欧拉角(滚转 φ、俯仰 θ、偏航 ψ)从四元数 q = [q0, q1, q2, q3] 涉及反正切函数。公式取决于角度约定(ZYX、XYZ 等)。在转换中注意万向节锁奇异点(θ = ±90°);在奇异点附近,直接使用四元数进行控制。
相关方法
参考文献
Shuster, M. D. (1993). A survey of attitude representations. Journal of the Astronautical Sciences, 41(4), 439–517.
打开出版物文献已复制。Titterton, D. H., & Weston, J. L. (2004). Strapdown Inertial Navigation Technology (2nd ed.). Institution of Engineering and Technology.
打开 DOI 文献已复制。Savage, P. G. (2000). Strapdown inertial navigation integration algorithm design. Part 1: Attitude algorithms. Journal of Guidance, Control, and Dynamics, 21(1), 19–28.
打开 DOI 文献已复制。