你说你2ms采样一次?加上你20深度的滤波,延迟看来会有点大。加大采样率试试吧。互补和卡尔曼都能稳飞的,这个不用怀疑。有时候程序里最简答的地方也会出错,好好看一下吧
贊同龍哥說法: PID 沒調好.
1、同样的pid,在使用DMP解算出来的数据可以稳定地飞行,为什么其他融合方式不行?
2、我在杆上实验,掰动到45度左右时,四轴可以在三四个周期恢复平衡,这样的效果还不够?
3、请问你认为pid没调好的依据是什么?
瞟了一眼你的程序,互补滤波部分
这两个数的取值,halfT是姿态解算周期的一半。Ki一般和halfT一样即可。