如何用四元数旋转加速度计数据获取地球坐标系X轴绝对加速度？

一、直接用四元数转换（推荐） #

IMU输出的四元数通常记为 q = (w, x, y, z)，表示地球坐标系到设备坐标系的旋转关系。要将设备坐标系下的加速度向量 A=(ax, ay, az) 转换到地球坐标系，需要用四元数的共轭进行反向旋转。

计算步骤 #

1. 先确定四元数的共轭 q* = (w, -x, -y, -z)
2. 代入以下展开公式直接计算地球坐标系下的加速度分量（无需理解复杂的四元数乘法规则）：

ax_global = (w² + x² - y² - z²)*ax + 2*(x*y - w*z)*ay + 2*(x*z + w*y)*az
ay_global = 2*(x*y + w*z)*ax + (w² - x² + y² - z²)*ay + 2*(y*z - w*x)*az
az_global = 2*(x*z - w*y)*ax + 2*(y*z + w*x)*ay + (w² - x² - y² + z²)*az

其中 ax_global 就是你需要的地球坐标系X轴绝对加速度（即问题中的x'）。

这种方法没有欧拉角的万向锁问题，计算效率和稳定性都更高，是工业界的首选方案。

二、转欧拉角后用旋转矩阵转换（不推荐，仅作参考） #

如果更习惯欧拉角的直观逻辑，可以先将四元数转成欧拉角，再通过旋转矩阵完成转换，但要注意万向锁问题（当俯仰角接近±90°时，滚转和偏航会出现耦合，计算结果异常）。

1. 四元数转欧拉角（Z-Y-X顺序：偏航yaw→俯仰pitch→滚转roll） #

roll = atan2(2*(w*x + y*z), 1 - 2*(x² + y²))
pitch = asin(2*(w*y - x*z))
yaw = atan2(2*(w*z + x*y), 1 - 2*(y² + z²))

注：atan2 返回的角度范围是[-π, π]，asin 返回的范围是[-π/2, π/2]，可根据需求转成角度制。

2. 构建旋转矩阵并计算 #

设备坐标系转地球坐标系的旋转矩阵（Z-Y-X顺序）如下：

R = [
    [ cos(yaw)cos(pitch),  cos(yaw)sin(pitch)sin(roll)-sin(yaw)cos(roll),  cos(yaw)sin(pitch)cos(roll)+sin(yaw)sin(roll) ],
    [ sin(yaw)cos(pitch),  sin(yaw)sin(pitch)sin(roll)+cos(yaw)cos(roll),  sin(yaw)sin(pitch)cos(roll)-cos(yaw)sin(roll) ],
    [ -sin(pitch),         cos(pitch)sin(roll),                           cos(pitch)cos(roll)                          ]
]

将加速度向量与矩阵相乘，得到地球坐标系加速度：

[ax_global]   [R[0][0] R[0][1] R[0][2]] [ax]
[ay_global] = [R[1][0] R[1][1] R[1][2]] [ay]
[az_global]   [R[2][0] R[2][1] R[2][2]] [az]

取结果的第一个分量即为目标的地球X轴加速度。

内容的提问来源于stack exchange，提问作者user9582784