其实自己搓卡尔曼的目标更多的事解决Z轴漂移，实测也有一定的优化，不过也会飘，只是飘的不那么离谱了而已，这个代码实测能跑。
我们后面想用jy901b，里面也自带滤波算法。
发动机侧向推力没有测试过，我们没有矢量试车台，下一步我们会转向鸭翼控制，非常感谢老哥的指导
无限可能
1. 公式行内显示(inline)：请使用 $....$ 或 \(....\) 包裹代码
2. 公式独占一行显示(display)：请使用 $$....$$ 或 \[....\] 包裹代码
3. 插入的公式在编辑时不会渲染，请检查无误后再插入。
