一种基于强跟踪的相关熵扩展卡尔曼滤波的组合导航方法技术

技术编号:13291087 阅读:123 留言:0更新日期:2016-07-09 09:30
本发明专利技术公开了一种基于强跟踪的相关熵扩展卡尔曼滤波的组合导航方法,步骤如下:建立飞行器导航系统的状态方程;建立SINS/GNSS组合导航系统的动力学方程;建立SINS/GNSS组合导航系统的量测方程;离散化SINS/GNSS组合导航的动力学方程和量测方程;对非线性离散后的动力学方程进行线性化;对线性化的动力学方程采用基于强跟踪的相关熵扩展卡尔曼滤波算法,输出SINS/GNSS组合导航的信息。本发明专利技术将强跟踪理论中的渐消因子引入到相关熵扩展卡尔曼滤波算法中,有效地解决了非线性SINS/GNSS组合导航系统的模型不确定性和噪声统计特性的非高斯问题,从而提高了导航精度,增强了导航过程的稳定性。

【技术实现步骤摘要】

本专利技术属于组合导航的
,具体涉及一种基于强跟踪的相关熵扩展卡尔曼滤波的组合导航方法,可用于提高飞行器、导弹、舰船、地面车辆的SINS/GNSS组合导航系统的精度。
技术介绍
高精度的组合导航一直以来是导航领域关注的关键问题。为了获得更高的导航精度,学者们和工业界人士致力于寻找具有鲁棒性和高精度的滤波方法,用于对载体的位置、速度、姿态等状态进行估计。捷联惯性导航系统(Serialinertialnavigationsystem,SINS)主要基于加速度二次积分的推算过程,自主性好、导航信息量大,但长时间工作导航精度变差。全球导航卫星系统(GlobalNavigationSatelliteSystem,GNSS)是以导航卫星为基础的无线电导航系统,具有较高的定位精度和测速精度,但是机载GNSS接收机接收信号时受载体飞行姿态的影响,地面GNSS接收机受所在地域的影响。这两种导航系统单独使用时,均存在不同的限制,难以达到理想的导航精度。而SINS/GNSS组合导航是组合上述两种导航设备的特点,利用导航滤波算法和计算机技术对多种导航信息进行综合处理,显著地提高了导航系统性能,特别是导航精度。针对SINS/GNSS组合导航系统而言,其组合滤波的非线性状态方程包括捷联惯导力学编排方程和姿态误差方程,故采用的导航滤波方法宜选取为非线性滤波方法。经典的扩展卡尔曼滤波方法通过时间更新和量测更新得到对状态进行估计,但当模型不精确或者噪声统计信息是非高斯时,滤波效果会很差,甚至会导致滤波过程发散。基于最大相关熵准则,有学者提出了相应的相关熵卡尔曼滤波算法,用于解决滤波过程中噪声的非高斯统计特性问题,取得了不错的效果。但是其未考虑模型的不确定性,针对这种模型的不确定性问题,基于强跟踪理论将渐消因子引入到相关熵卡尔曼滤波算法中,提出了一种基于强跟踪的相关熵扩展卡尔曼滤波的SINS/GNSS组合导航方法,能有效地解决SINS/GNSS组合导航系统的非线性问题,以及噪声统计特性的非高斯问题,提高了SINS/GNSS组合导航的精度。
技术实现思路
针对SINS/GNSS组合导航系统模型的不确定性和噪声的非高斯特性,本专利技术提供了一种基于强跟踪的相关熵扩展卡尔曼滤波的组合导航方法,基于最大相关熵准则建立了相关熵卡尔曼滤波方法,将渐消因子引入到相关熵扩展卡尔曼滤波方法,提高滤波精度。该方法利用强跟踪理论的特点,最大限度的消除模型的不确定性对SINS/GNSS组合导航的精度的影响,提高导航滤波精度,增强导航滤波稳定性。为了达到上述目的,本专利技术提出了一种基于强跟踪的相关熵扩展卡尔曼滤波的组合导航方法,包括以下五个步骤:步骤一:建立SINS/GNSS组合导航系统的动力学方程在东北天地理坐标系下,SINS/GNSS组合导航系统的动力学方程为:φ·E=(ωiesinL+vERN+htanL)φN-(ωiecosL+vERN+h)φU-δvERM+h+vN(RM+h)2δh+ϵbE+wgE---(1)]]>φ·N=-(ωiesinL+vERN+htanL)φE-vNRM+hφU+δvERN+h-vE(RN+h)2δh-ωieδLsin+ϵbN+wgN---(2)]]>φ·U=(ωiecosL+vERN+h)φE+vNRM+hφN+tanLRN+hδvE-vEtanL(RM+h)2δh+(ωiecosL+vEsec2LRN+h)δL+ϵbU+wgU---(3)]]>v·E=(2ωiesinL+vERN+htanL)vN-(2ωiecosL+vERN+h)vU+fE+fNφU-fUφN---(4)]]>v·N=-(2ωiesinL+vERN+htanL)vE-vNRM+hvU+fEφU+fN-fUφE---(4)]]>v·U=(2ωiecosL+vERN+htanL)vE+vN2RM+h-g-fEφN+fNφE+fU---(5)]]>L·=vNRM+h---(6)]]>λ·=vE(RN+h)cosL---(7)]]>h·=vU---(8)]]>其中,φE,φN,φU分别是东、北、天的高度,vE,vN,vU分别是东、北、天的速度,L,λ,h分别为地理纬度、经度和高度;fE,fN,fU分别为东北天三个轴向的加速度计输出的比力测量值,δvE,δvN,δL,δh分别是惯导系统的速度、位置输出减去GNSS对应输出的近似值;RM为RM=Re(1-2e+3esin2L),RN为RN=Re(1-esin2L),其中Re=6378137.0m为地球长半径,e=1/298.257是地球扁率,ωie=7.292×10-5rad/s是地球自转角速度,g=9.78m/s2是重力加速度;地球陀螺东北天常值漂移εbE,εbN,εbU分别为:ϵ·bE=0,ϵ·bN=0,ϵ·bU=0---(9)]]>其中,wgE,wgN,wgU分别是陀螺东、北、天的噪声;状态向量为x=[φE,φN,φU,vE,vN,vU,L,λ,h,εbE,εbN,εbU]T,则其动力学方程为x·=f(x)+w---(10)]]>式中,w为系统的噪声;步骤二:建立SINS/GNSS组合导航系统的量测方程选取GNSS输出的载体速度信息vEG,vNG,vUG和位置信息LG,λG,hG作为量测值组成量测方程:y=[vEG,vNG,vUG,LG,λG,hG]T(11)则相应的量测方程为y=Hx+v(12)其中,量测方程系数矩阵H为H=[I6×6,O6×6],I为单位矩阵,O为零矩阵,v为量测噪声。步骤三:离散化SINS/GNSS组合导航的动力学方程和量测方程将式(10)的动力学方程和式(12)的量测方程进行离散化,得到非线性的状态方程和线性的量测方程:xk=f(xk-1)+wk-1(13)yk=Hxk+vk(14)其中,xk为状态向量,f(·)为非线性离散函数,wk本文档来自技高网
...

【技术保护点】
一种基于强跟踪的相关熵扩展卡尔曼滤波的组合导航方法,其特征在于,包括以下步骤:步骤一:建立SINS/GNSS组合导航系统的动力学方程在东北天地理坐标系下,SINS/GNSS组合导航系统的动力学方程为:φ·E=(ωiesin L+vERN+htan L)φN-(ωiecos L+vERN+h)φU-δvERM+h+vN(RM+h)2δh+ϵbE+wgE...(1)]]>φ·N=-(ωiesin L+vERN+htan L)φE-vNRM+hφU+δvERN+h-vE(RN+h)2δh-ωieδL sin L+ϵbN+wgN...(2)]]>φ·U=(ωiecos L+vERN+h)φE+vNRM+hφN+tan LRN+hδvE-vEtan L(RM+h)2δh+(ωiecos L+vEsec2LRN+h)δL+ϵbU+wgU...(3)]]>v·E=(2ωiesin L+vERN+htan L)vN-(2ωiecos L+vERN+h)vU+fE+fNφU-fUφN....(4)]]>v·N=-(2ωiesin L+vERN+htan L)vE-vNRM+hvU+fEφU+fN-fUφE...(5)]]>v·U=(2ωiecos L+vERN+htan L)vE+vN2RM+h-g-fEφN+fNφE+fU...(6)]]>L·=vNRM+h...(7)]]>λ·=vE(RN+h)cos L...(8)]]>h·=vU...(9)]]>其中,φE,φN,φU分别是东、北、天的高度,vE,vN,vU分别是东、北、天的速度,L,λ,h分别为地理纬度、经度和高度;fE,fN,fU分别为东北天三个轴向的加速度计输出的比力测量值,δvE,δvN,δL,δh分别是惯导系统的速度、位置输出减去GNSS对应输出的近似值;RM为RM=Re(1‑2e+3esin2L),RN为RN=Re(1‑esin2L),其中Re=6378137.0m为地球长半径,e=1/298.257是地球扁率,ωie=7.292×10‑5rad/s是地球自转角速度,g=9.78m/s2是重力加速度;地球陀螺东北天常值漂移εbE,εbN,εbU分别为:ϵ·bE=0,ϵ·bN=0,ϵ·bU=0...(10)]]>其中,wgE,wgN,wgU分别是陀螺东、北、天的噪声;状态向量为x=[φE,φN,φU,vE,vN,vU,L,λ,h,εbE,εbN,εbU]T,则其动力学方程为x·=f(x)+w...(11)]]>式中,w为系统的噪声;步骤二:建立SINS/GNSS组合导航系统的量测方程选取GNSS输出的载体速度信息vEG,vNG,vUG和位置信息LG,λG,hG作为量测值组成量测方程:y=[vEG,vNG,vUG,LG,λG,hG]T··················(12)则相应的量测方程为y=Hx+v····················(13)其中,量测方程系数矩阵H为H=[I6×6,O6×6],I为单位矩阵,O为零矩阵,v为量测噪声。步骤三:离散化SINS/GNSS组合导航的动力学方程和量测方程将式(11)的动力学方程和式(13)的量测方程进行离散化,得到非线性的状态方程和线性的量测方程:xk=f(xk‑1)+wk‑1·················(14)yk=Hxk+vk·················(15)其中,xk为状态向量,f(·)为非线性离散函数,wk为系统噪声向量;yk为量测向量;vk为量测噪声向量,k是指第k步,代表tk时刻;系统噪声向量wk和量测噪声向量vk满足:Cov[wk,vj]=E[wkvjT]=0...(16)]]>步骤四:对非线性离散后的动力学方程进行线性化首先,将式(14)中的非线性离散函数f(xk‑1)围绕估计值展开成泰勒级数,并略去二阶以上的项,得线性化之后的状态方程:xk=Φk/k‑1xk‑1+uk‑1+wk‑1···...

【技术特征摘要】
1.一种基于强跟踪的相关熵扩展卡尔曼滤波的组合导航方法,其特征在于,包括以下
步骤:
步骤一:建立SINS/GNSS组合导航系统的动力学方程
在东北天地理坐标系下,SINS/GNSS组合导航系统的动力学方程为:
φ·E=(ωiesinL+vERN+htanL)φN-(ωiecosL+vERN+h)φU-δvERM+h+vN(RM+h)2δh+ϵbE+wgE...(1)]]>φ·N=-(ωiesinL+vERN+htanL)φE-vNRM+hφU+δvERN+h-vE(RN+h)2δh-ωieδLsinL+ϵbN+wgN...(2)]]>φ·U=(ωiecosL+vERN+h)φE+vNRM+hφN+tanLRN+hδvE-vEtanL(RM+h)2δh+(ωiecosL+vEsec2LRN+h)δL+ϵbU+wgU...(3)]]>v·E=(2ωiesinL+vERN+htanL)vN-(2ωiecosL+vERN+h)vU+fE+fNφU-fUφN....(4)]]>v·N=-(2ωiesinL+vERN+htanL)vE-vNRM+hvU+fEφU+fN-fUφE...(5)]]>v·U=(2ωiecosL+vERN+htanL)vE+vN2RM+h-g-fEφN+fNφE+fU...(6)]]>L·=vNRM+h...(7)]]>λ·=vE(RN+h)cosL...(8)]]>h·=vU...(9)]]>其中,φE,φN,φU分别是东、北、天的高度,vE,vN,vU分别是东、北、天的速度,L,λ,h分别
为地理纬度、经度和高度;fE,fN,fU分别为东北天三个轴向的加速度计输出的比力测量值,δ
vE,δvN,δL,δh分别是惯导系统的速度、位置输出减去GNSS对应输出的近似值;RM为RM=Re(1-
2e+3esin2L),RN为RN=Re(1-esin2L),其中Re=6378137.0m为地球长半径,e=1/298.257是
地球扁率,ωie=7.292×10-5rad/s是地球自转角速度,g=9.78m/s2是重力加速度;地球陀
螺东北天常值漂移εbE,εbN,εbU分别为:
ϵ·bE=0,ϵ·bN=0,ϵ·bU=0...(10)]]>其中,wgE,wgN,wgU分别是陀螺东、北、天的噪声;
状态向量为x=[φE,φN,φU,vE,vN,vU,L,λ,h,εbE,εbN,εbU]T,则其动力学方程为
x·=f(x)+w...(11)]]>式中,w为系统的噪声;
步骤二:建立SINS/GNSS组合导航系统的量测方程
选取GNSS输出的载体速度信息vEG,vNG,vUG和位置信息LG,λG,hG作为量测值组成量测方
程:
y=[vEG,vNG,vUG,LG,λG,hG]T··················(12)
则相应的量测方程为
y=Hx+v····················(13)
其中,量测方程系数矩阵H为H=[I6×6,O6×6],I为单位矩阵,O为零矩阵,v为量测噪声。
步骤三:离散化SINS/GNSS组合导航的动力学方程和量测方程
将式(11)的动力学方程...

【专利技术属性】
技术研发人员:靳攀齐艳珂马淑芳魏峰窦小磊娄泰山
申请(专利权)人:郑州航空工业管理学院
类型:发明
国别省市:河南;41

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

1