从IMU加速度计上移除重力

Question

我发现这个beautiful quick way可以从加速度计读数中去除重力。但是，我有一个6dof IMU（xyz陀螺仪，xyz accel，没有磁力计），所以我不确定我是否可以使用这个代码（我试过，它无法正常工作）。

有人会如何移除重力组件？这是一个很大的障碍，因为我无法继续我的项目。

---

修改

我有什么：

• 描述飞机位置的四元数（使用扩展卡尔曼滤波器获得）
• 加速度传感器读数（未过滤;轴在平面对齐时对齐;重力也包含在这些读数中）

我想要的是什么：

• 移除重力
• 校正（旋转）加速度计读数，使其轴与地球的参考轴对齐
• 读取向地球的加速度（现在是加速度计的Z分量）

基本上我想读取飞机朝向地球的加速度！但是第一步是去除重力我猜。

Answer 1

更新：好的，所以您需要的是使用四元数旋转矢量。请参阅here或here。

您可以使用四元数（对应于方向）旋转测量的加速度矢量，然后从结果中减去重力[0, 0, 9.81]（根据您的符号约定，您可能有-9.81）。就是这样。

---

我已根据此Shimmer 2为manuscript设备实施了传感器融合，我强烈推荐它。它只使用加速度计和陀螺仪，但没有磁力计，而且完全符合您的要求。

您在问题中链接的资源具有误导性。它依赖于传感器融合的四元数。换句话说，有人已经为你做了繁重的工作，已经为你准备了重力补偿。