c - 如何使用 FFT 清除加速度计的噪声信号

Question

我正在使用加速度计 3 轴来获取加速度，然后使用 C 中的以下公式计算滚动角和俯仰角。

滚动 = atan2(aux_y, aux_z) * 57.3;
音高 = atan2((-aux_x), sqrt(aux_y * aux_y + aux_z * aux_z)) * 57.3;

它工作正常 0º 是 0.3º，但问题是当我得到像卡车马达等一些振动噪音时，结果是“疯狂”的 0 变为 22、45、16 等，我需要清理我的振动信号，一些同事向我提到我必须使用 FFT 来清理它，但我不太确定该怎么做。

标签： cfftaccelerometer