自己写卡尔曼,精度恐怕问题不小吧
线性化处理后的模型会存在较大的截断误差,感觉以328p这种小芯片的算力跑不了UT变换,所以性价比更高的是用自带滤波的陀螺仪。(记得捷特智能的jy61p精度不错,价格也还好。)
发动机的侧向推力有测么,视频看不清。
做做尾翼性价比更高,矢量发动机大可不必。