一种微惯性SINS/GPS组合导航系统的自适应滤波方法技术方案

技术编号:9141305 阅读:164 留言:0更新日期:2013-09-12 03:13
本发明专利技术公开了一种微惯性SINS/GPS组合导航系统的自适应滤波方法,其目的是改善由短时GPS信号丢失或受到干扰导致常规卡尔曼滤波发散的情况,提高MEMS-SINS/GPS组合导航系统的定位精度。该方法借助新息序列和滤波估计值在线估计量测噪声统计信息,建立关于新息序列的限定窗口平滑器对新息序列进行平滑处理,并利用GPS提供的量测数据和滤波信息修正滤波估计均方误差,完成自适应卡尔曼滤波递推运算。本发明专利技术设计的方法能够克服短时间内量测数据不准引起的滤波发散问题,实时修正滤波估计均方误差,提高了MEMS-SINS/GPS组合导航系统的鲁棒性和导航定位精度。

【技术实现步骤摘要】

【技术保护点】
一种微惯性SINS/GPS组合导航系统的自适应滤波方法,其特征在于,包括以下步骤:步骤一:建立MEMS?SINS的误差方程,利用GPS与SINS提供的速度差值作为量测信息,建立MEMS?SINS/GPS组合导航系统的状态方程和量测方程;步骤二:利用由步骤一得到的k时刻量测值Zk和滤波器的一步预测值计算当前时刻新息序列εk;步骤三:利用k时刻的新息序列εk和k?1时刻的滤波信息,对k时刻的量测噪声协方差阵进行在线估计;步骤四:确定平滑窗口的宽度N,并借助步骤二得到新息序列新息εk,建立关于量测新息的协方差阵的限定窗口平滑器;步骤五:根据步骤三和步骤四得到的量测噪声估值器和窗口平滑器,借助k时刻的量测信息对滤波器的一步预测估计均方误差进行修正;步骤六:在步骤二、三、五的基础上,将k时刻的量测噪声估计值、新息序列值以及一步预测均方误差的修正值带入滤波过程中,建立自适应卡尔曼滤波器,并依次进行组合导航的递推解算。FSA00000891448300011.tif,FSA00000891448300013.tif

【技术特征摘要】

【专利技术属性】
技术研发人员:孙枫夏秀玮李敬春田学林
申请(专利权)人:哈尔滨工程大学
类型:发明
国别省市:

网友询问留言 已有0条评论
  • 还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。

1