基于长航时飞行器的SINS/GNSS自适应组合导航算法*
2016-12-20杨鹏翔
弹箭与制导学报 2016年3期
陈 沣,杨鹏翔
(中国兵器工业第203研究所,西安 710065)
基于长航时飞行器的SINS/GNSS自适应组合导航算法*
陈 沣,杨鹏翔
(中国兵器工业第203研究所,西安 710065)
当GNSS出现故障时,SINS/GNSS组合导航系统的输出误差就会增加,影响导航系统的性能。在此情况下,为了使组合导航系统的输出更加准确,文中论述了一种量测修正算法。该算法通过检查卡尔曼滤波残差,调整量测更新过程中观测量的权值,对状态量进行修正,减少了观测量异常对输出结果的影响。最后对量测修正算法以及简化的Sage-Husa自适应算法进行了仿真。仿真结果表明,两种方法得到的误差均优于标准卡尔曼滤波。
长航时导航;无人飞行器;自适应组合导航;算法仿真;卡尔曼滤波器
0 引言
无人机、巡飞弹等飞行器要求的导航时间大于30 min,而低成本的捷联惯性导航系统(SINS)无法满足如此长时间的导航需求;单独使用卫星导航系统(GNSS)又有被干扰或遮挡造成失效的风险。所以,一般长航时飞行器采用SINS/GNSS组合导航系统。当GNSS误差增加甚至失效时,不同的组合导航算法策略对于导航系统最终输出的误差影响很大。文中介绍了一种简化的Sage-Husa自适应卡尔曼滤波和一种量测修正卡尔曼滤波,并仿真分析这两种算法对隔离GNSS故障的效果。
1 航行轨迹设置
文中针对的是长航时飞行器的仿真,所以航行轨迹时间设置为1 049 s。航行轨迹的参数如表1所示。
设定惯性器件采样周期Ts=10 ms,惯性导航算法更新周期Tm=20 ms。
利用龙格-库塔数值解法解微分方程,可以由上表得出轨迹中各个时刻的姿态、位置、速度、陀螺角增量、加速度计比力增量信息[1]。……
登录APP查看全文
