姿态表示转换

R = Rz(Yaw) · Ry(Pitch) · Rx(Roll)，右手系，固定轴 XYZ。

四元数顺序 [w, x, y, z]；非零输入会归一化，q 与 −q 表示相同姿态。