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