分享我的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-26 11:05
顶一个,楼主偶看啦
long2016
2楼-- · 2019-07-26 16:43
因为使用DMP速度太慢了,用DMP最大速率才200HZ
方向很重要
3楼-- · 2019-07-26 18:48
楼主大神,请问你的源码是直接将GY-521对应连接到PA0与PA1上,之后串口1(PA9,PA10)直接发送给上位机是么?本人初学,请谅解一些很愚笨的问题,我按照我所说的连了线了,之后也下载进去了,我试了几次发现在while(1)之前的那while就卡住了,求解。谢谢您。
wszdxmh
4楼-- · 2019-07-26 23:44
方向很重要 发表于 2016-8-6 01:22
楼主大神,请问你的源码是直接将GY-521对应连接到PA0与PA1上,之后串口1(PA9,PA10)直接发送给上位机是么 ...

如果是卡在DMP的初始化的话,请把模块放平再试一次,之前我就是这样的。
华丽与creazy
5楼-- · 2019-07-27 01:18
 精彩回答 2  元偷偷看……
wszdxmh
6楼-- · 2019-07-27 06:11
华丽与creazy 发表于 2016-8-9 18:20
我用printf("%0.2f    %0.2f    %0.2f ",Angle,Angle_ax,Gyro_y);函数分别读取的加速度,角速度和倾角, ...

http://www.openedv.com/forum.php ... mp;page=1#pid459593
目测你是移植了一个别人的错误的代码,不行就下载我的程序试试,还有,没有波形图吗?有什么比图更直接?

一周热门 更多>