gpt4 book ai didi

algorithm - 实现 Madgwick IMU 算法

转载 作者:塔克拉玛干 更新时间:2023-11-03 02:41:36 24 4
gpt4 key购买 nike

我正在尝试使用 Sebastian Madgwick 的 IMU algorithms从我的传感器(MPU-9150)获取滚动、俯仰和偏航。我下载的文件夹带有一些样本数据,我只是用我自己的数据替换了这些数据,确保单位/约定相同等。问题是算法的输出角度和我的数据没有多大意义,非常嘈杂,尤其是偏航角。滚转和俯仰似乎是合理的,但我可以从我的加速度计/陀螺仪数据中得到更好的结果。我附上了他的示例数据(有效)、我的数据和输出的图表。

在尝试使用这些算法之前,是否需要对我的数据进行一些额外的过滤?到目前为止,我一直在玩弄中值过滤,这似乎没有什么不同。

谢谢

Example data Example data output My data My data output

最佳答案

我碰巧发现了 Tobias Simon 关于 Magdwick 算法不稳定性问题的一些说明,详见此处

http://diydrones.com/forum/topics/madgwick-imu-ahrs-and-fast-inverse-square-root

问题出在 Magdwick 实现中使用的快速平方根反比。我不清楚问题出在哪里。也许是算法的精度问题,也许是因为原始代码在 64 位机器上无法运行。用不同的(更好的?)替换实现可以实现更好、更稳定的 AHRS 计算。 (或者针对 64 位机器对代码做一些小改动也解决了这个问题?请阅读 Tobias Simon 原始笔记的评论。)

可以在此处找到更好的平方根反比实现

https://pizer.wordpress.com/2008/10/12/fast-inverse-square-root/

关于algorithm - 实现 Madgwick IMU 算法,我们在Stack Overflow上找到一个类似的问题: https://stackoverflow.com/questions/23599256/

24 4 0
Copyright 2021 - 2024 cfsdn All Rights Reserved 蜀ICP备2022000587号
广告合作:1813099741@qq.com 6ren.com