多旋翼姿态解算中的改进自适应扩展Kalman算法

• 作者: 宫勋 张欣 王日俊 白越 续志军 赵常均
• 来源期刊: 光学精密工程
• 学科: 工学
• 关键词: 多旋翼无人机 姿态解算 自适应滤波 扩展Kalman滤波
• 年，卷（期）: 2014,（12）
• 所属期刊栏目: 信息科学
• 页码范围: 3384-3390
• 页数: 7页
• 分类号: V448.22|TP301.6
• 字数: 3737字
• 语种: 中文
• DOI: 10.3788/OPE.20142212.3384

摘要

提出了一种改进的Sage-Husa自适应扩展Kalman滤波算法,用于保证多旋翼无人机在噪声统计特性未知且时变、振动为主要扰动源、姿态角高动态变化等飞行条件下飞行姿态角解算的精度与稳定性.该算法采用微机电系统陀螺仪实时动态解算的姿态角方差估计系统噪声方差;并采用自适应滤波算法在线估计量测噪声方差,从而保证滤波的精度与稳定性;同时引入滤波器收敛性判据,结合强跟踪Kalman滤波算法来抑制滤波发散.飞行实验与分析表明:改进算法解算的俯仰角与横滚角均方根误差分别为1.722°和1.182°,明显优于常规的Sage-Husa自适应滤波算法.实验还显示:改进的算法自适应能力强、实时性好、精度高、运行可靠,能够满足多旋翼无人机自主飞行的需要,若对参数进行适当修改,还可应用于其它动态性能要求较高的导航信息测量系统中.