分享我的MPU6050+卡尔曼+一阶互补+二阶互补滤波

2019-07-21 06:32发布

本帖最后由 wszdxmh 于 2016-8-23 15:12 编辑

不说,上图
X-Kalman.png
X-Kalman滤波
Y-Kalman.png
Y-Kalman滤波
Z-Kalman.png
Z-Kalman滤波,这个滤得不是很好。
X-Thr.png
X轴三种滤波对比图
Big.png
放大图
一阶互补跟随快,但是抗干扰也会差一点,其他两个要等几个周期才会跟随比较好,应该是要更新参数。
上代码。
STM32F103VModel.zip (409.82 KB, 下载次数: 5987) 2016-7-22 09:53 上传 点击文件名下载附件
滤波代码

匿名上位机
ANO_TC匿名科创地面站v4.06.rar (13.66 MB, 下载次数: 17406) 2016-7-22 10:17 上传 点击文件名下载附件
匿名地面站V4.0

UCOSIII移植版
STM32F103C8T6Model-UCOSIII.zip (1.65 MB, 下载次数: 7163) 2016-8-23 15:11 上传 点击文件名下载附件
UCOSIII版


现在研究PID算法,有空再更。








友情提示: 此问题已得到解决,问题已经关闭,关闭后问题禁止继续编辑,回答。
该问题目前已经被作者或者管理员关闭, 无法添加新回复
48条回答
望着你发槑
1楼-- · 2019-07-22 04:03
谢谢              
橘子先生
2楼-- · 2019-07-22 09:20
问一下楼主u16类型的加速度计值和陀螺仪值在代入互补滤波的计算公式之前需要处理吗?如果需要那要怎么处理?
橘子先生
3楼-- · 2019-07-22 11:59
wszdxmh 发表于 2016-7-23 22:27
需要用反切计算为角度,因为输入的参数为速度和角度,所以要把采集的角速度转换成角度。你可以下载我的工 ...

啊,好的,我回去试试,谢啦
神秘狼
4楼-- · 2019-07-22 14:26
顶顶顶
橘子先生
5楼-- · 2019-07-22 17:25
 精彩回答 2  元偷偷看……
wszdxmh
6楼-- · 2019-07-22 23:09
橘子先生 发表于 2016-7-25 13:40
问下楼主这里的分辨率是什么意思?跟实际测得的数值有什么联系?

上面写得很清楚啊。
这个跟后面的算正负号有关系。

一周热门 更多>