一种基于多模型自适应滤波的自主导航方法技术

技术编号:8488237 阅读:177 留言:0更新日期:2013-03-28 06:51
一种基于多模型自适应滤波的自主导航方法,基本方法为:首先,选择航天器的位置和速度矢量作为状态变量,选取不同的初始状态建立多个模型,用于描述航天器初始误差;其次,针对多个模型建立多个并行扩展卡尔曼滤波算法,分别进行滤波,获得多个状态估计值;再次,根据各个并行扩展卡尔曼滤波算法的状态估计值与观测量相符合的程度计算相应的滤波权值;最后,根据滤波权值计算各个并行扩展卡尔曼滤波算法的状态估计值的加权和,得到导航滤波结果。该方法能够解决航天器初始位置误差影响航天器自主导航性能的问题,达到增强导航滤波收敛性和快速性的目的。

【技术实现步骤摘要】

本专利技术涉及,属于卫星自主导航技术 领域。
技术介绍
航天器自主导航系统通过其自身的仪器设备确定航天器的位置和速度。自主导航 系统技术研究对于减轻航天任务对地面测控的依赖、提高航天器的自主生存能力具有重要 意义。航天器自主导航的基本方法是选择航天器的位置和速度矢量作为状态变量,根据航 天器的轨道动力学模型建立状态方程,将导航敏感器的测量模型作为观测方程,通过适当 的导航滤波算法处理导航敏感器的观测信息,通过递推计算得到航天器在某个指定参考坐 标系的位置矢量和速度矢量的估计值。不同的导航方式由于导航信息源和导航敏感器的不 同,观测方程有所不同。目前应用最广的导航滤波算法是扩展卡尔曼滤波算法。扩展卡尔曼滤波算法的性 能易受航天器初始位置误差的影响,航天器初始位置误差较大的情况下,有可能造成滤波 收敛过程中估计误差振荡幅度显著加剧、滤波收敛变慢,甚至导致滤波不收敛。
技术实现思路
本专利技术的技术解决问题是针对航天器初始位置误差影响自主导航性能的问题, 提出,应用该方法能够在航天初始位置误差较 大的情况下,增强导航系统的收敛性和快速性。本专利技术的技术解决方案是,步骤如下(I)选择参与自主导航的两个航天器的位置矢量和速度矢量作为状态变量,根据 所述状态变量建立状态转移函数、测量函数和由多个不同的初始状态变量构成的模型集;(2)以模型集中的各个元素作为初始值,利用步骤(I)得到的状态转移函数和测 量函数,通过并行扩展卡尔曼滤波算法进行递推解算,获得并行扩展卡尔曼滤波算法的状 态变量估计值,并计算并行扩展卡尔曼滤波算法的测量残差;(3)根据步骤(2)得到的测量残差计算并行扩展卡尔曼滤波算法的权值;(4)根据步骤(2)得到的各个并行扩展卡尔曼滤波算法的状态变量估计值和步骤(3)得到的各个并行扩展卡尔曼滤波算法的权值计算状态变量估计值的加权和,加权和即 为当前时刻多模型自适应滤波的状态变量估计值;(5)将步骤⑵到步骤(4)进行重复迭代,获得不同时刻多模型自适应滤波的状态 变量估计值,即获得了两个航天器的位置和速度信息,从而实现航天器的基于多模型自适 应滤波的自主导航。所述步骤(I)中状态变量为之⑴=[(KW (g2WT其中,权利要求1.,其特征在于步骤如下(1)选择参与自主导航的两个航天器的位置矢量和速度矢量作为状态变量,根据所述状态变量建立状态转移函数、测量函数和由多个不同的初始状态变量构成的模型集;(2)以模型集中的各个元素作为初始值,利用步骤(I)得到的状态转移函数和测量函数,通过并行扩展卡尔曼滤波算法进行递推解算,获得并行扩展卡尔曼滤波算法的状态变量估计值,并计算并行扩展卡尔曼滤波算法的测量残差;(3)根据步骤(2)得到的测量残差计算并行扩展卡尔曼滤波算法的权值;(4)根据步骤(2)得到的各个并行扩展卡尔曼滤波算法的状态变量估计值和步骤(3)得到的各个并行扩展卡尔曼滤波算法的权值计算状态变量估计值的加权和,加权和即为当前时刻多模型自适应滤波的状态变量估计值;(5)将步骤(2)到步骤(4)进行重复迭代,获得不同时刻多模型自适应滤波的状态变量估计值,即获得了两个航天器的位置和速度信息,从而实现航天器的基于多模型自适应滤波的自主导航。2.根据权利要求1所述的,其特征在于所述步骤(I)中状态变量为其中,3.根据权利要求1所述的,其特征在于所述步骤(2)中通过并行扩展卡尔曼滤波算法进行递推解算,获得并行扩展卡尔曼滤波算法的状态变量估计值具体为4.根据权利要求1所述的,其特征在于所述步骤(3)中的权值计算过程如下对于第τ个滤波器,权值μ,(τ)的计算公式为5.根据权利要求1所述的,其特征在于步骤(4)中所述加权和的计算公式如下全文摘要,基本方法为首先,选择航天器的位置和速度矢量作为状态变量,选取不同的初始状态建立多个模型,用于描述航天器初始误差;其次,针对多个模型建立多个并行扩展卡尔曼滤波算法,分别进行滤波,获得多个状态估计值;再次,根据各个并行扩展卡尔曼滤波算法的状态估计值与观测量相符合的程度计算相应的滤波权值;最后,根据滤波权值计算各个并行扩展卡尔曼滤波算法的状态估计值的加权和,得到导航滤波结果。该方法能够解决航天器初始位置误差影响航天器自主导航性能的问题,达到增强导航滤波收敛性和快速性的目的。文档编号G01C21/24GK102997923SQ20121050476公开日2013年3月27日 申请日期2012年11月30日 优先权日2012年11月30日专利技术者熊凯, 王大轶, 黄翔宇, 李骥 申请人:北京控制工程研究所本文档来自技高网...

【技术保护点】
一种基于多模型自适应滤波的自主导航方法,其特征在于步骤如下:(1)选择参与自主导航的两个航天器的位置矢量和速度矢量作为状态变量,根据所述状态变量建立状态转移函数、测量函数和由多个不同的初始状态变量构成的模型集;(2)以模型集中的各个元素作为初始值,利用步骤(1)得到的状态转移函数和测量函数,通过并行扩展卡尔曼滤波算法进行递推解算,获得并行扩展卡尔曼滤波算法的状态变量估计值,并计算并行扩展卡尔曼滤波算法的测量残差;(3)根据步骤(2)得到的测量残差计算并行扩展卡尔曼滤波算法的权值;(4)根据步骤(2)得到的各个并行扩展卡尔曼滤波算法的状态变量估计值和步骤(3)得到的各个并行扩展卡尔曼滤波算法的权值计算状态变量估计值的加权和,加权和即为当前时刻多模型自适应滤波的状态变量估计值;(5)将步骤(2)到步骤(4)进行重复迭代,获得不同时刻多模型自适应滤波的状态变量估计值,即获得了两个航天器的位置和速度信息,从而实现航天器的基于多模型自适应滤波的自主导航。

【技术特征摘要】

【专利技术属性】
技术研发人员:熊凯王大轶黄翔宇李骥
申请(专利权)人:北京控制工程研究所
类型:发明
国别省市:

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

1