一种SINS/GPS/偏振光组合导航***多目标优化抗干扰滤波方法
技术领域
本发明涉及一种SINS/GPS/偏振光组合导航***多目标优化抗干扰滤波方法。该方法充分利用了SINS/GPS/偏振光组合导航***中存在的多源干扰特性,通过设计干扰估计器的方法抵消可建模干扰,设计混合鲁棒滤波器来抑制高斯噪声和范数有界干扰,可提高导航***的精度、可靠性以及抗干扰能力。
背景技术
随着航空工程领域飞行器的工作环境变得日益复杂,对飞行器自主性、抗干扰性和快速反应能力提出了越来越高的要求,因此导航***的滤波精度以及可靠性变的越来越重要。受到硬件技术以及成本的限制,单一的导航***很难满足载体的自主性,抗干扰性和快速反应的需求。研究抗干扰性强、精度高的滤波算法是解决问题的途径之一。
SINS/GPS/偏振光组合导航***为一多源干扰***。SINS自身存在的模型不确定性,量测噪声、惯性器件漂移,机械振动、空间环境等干扰。GPS受到的电磁干扰;偏振传感器存在的光电器件的输出误差,偏振传感器的安装误差,传感器的采集、处理与控制电路在工作时产生的电热噪声随机误差,以及传感器在工作中由环境变化引起的输入误差。SINS误差方程、GPS伪距量测方程、偏振光量测方程本质上都是非线性的。上述这些干扰共同作用使得SINS/GPS/偏振光组合导航表现出非常复杂的非线性。
卡尔曼滤波器(KF)是一种最小方差的最优估计器,已经广泛的应用到实际***中,但是卡尔曼滤波器将干扰假设为单一的高斯噪声,且要求***模型足够准确,因此传统的卡尔曼滤波器具有很大的保守性,对于多源干扰***,难以实现高精度控制和估计。对于非线性***,处理方法主要有扩 展卡尔曼滤波(EKF)、无迹卡尔曼滤波(UKF)、粒子滤波,H2/H∞+DOBC抗干扰滤波等。EKF将非线性模型基于泰勒级数展开,取一阶截断作为原状态方程和量测方程的近似,EKF要求噪声为高斯噪声且模型足够准确,EKF滤波方法在线性化的过程中存在着舍入误差,因此产生较大的模型误差,***存在着模型不确定性,且对于非高斯噪声等其他干扰不能很好的估计,因此对滤波精度有一定的影响。UKF可以直接应用于非线性模型,但要求噪声为高斯噪声,且UKF计算量较大,不能有效的实施。粒子滤波算法复杂、计算量大,实时性差,在实际应用中存在很多问题。
多目标优化抗干扰滤波充分利用了***中干扰的特性,将***中干扰进行分类建模,对于某些特性已知的干扰,可以充分利用其信息,分别采用干扰抵消和干扰抑制的方法,建立一类同时具有干扰抵消与抑制性能的多目标优化抗干扰滤波方法的研究框架。可建模的干扰通过设计干扰观测器来抵消,设计鲁棒滤波器来抑制高斯噪声和能量有限的干扰。建立含有多源干扰的惯性导航***误差新模型,并将多目标优化抗干扰滤波方法应用到SINS/GPS/偏振光组合导航中,提高惯性导航***的滤波精度、可靠性以及抗干扰能力。
发明内容
本发明要解决的技术问题是:克服SINS的机械振动、建模误差、非线性动态、环境干扰等干扰,提供一种精度高、可靠性强、抗干扰能力强的SINS/GPS/偏振光导航***多目标优化抗干扰滤波方法。
本发明解决其技术问题所采用的技术方案为:将SINS、GPS、偏振传感器以及环境中的干扰进行分类,对不同类型的干扰进行干扰建模,高斯随机变量和范数有界未知变量分别通过H2技术以及H∞技术来抑制,可建模干扰通过设计干扰观测器来抵消。
具体包括以下步骤:
(1)建立以偏振方位角α为量测量的量测方程;
(2)充分利用干扰特性,建立基于失准角速度v、位置p为状态的状态方程以及基于速度v、位置p以及偏振方位角α为量测量的量测方程,并将状态方程和量测方程离散化;
(3)对***的干扰进行分类,对不同类型的干扰进行干扰建模;
(4)设计漂移估计器估计并抵消可建模干扰;
(5)根据设计的漂移估计器,构造H2/H∞混合滤波器;
(6)构造状态估计误差***,用多目标优化抗干扰滤波算法对所述H2/H∞混合滤波器进行集中式滤波,并输出导航信息。
所述的步骤(1)中基于偏振方位角α为量测量的量测方程中的量测量为:
其中,
为载体坐标系到偏振模块坐标系的姿态转换矩阵,
为导航系和载体系之间姿态转移矩阵的名义值,
为地理系和导航系之间姿态转移矩阵的名义值,Φ
×为姿态角的反对称矩阵,δθ
×为[δλsinLδλcosLδL]的反对称矩阵,
为导航坐标系到载体坐标系的姿态转换矩阵,
为地球坐标系到导航坐标系的姿态转换矩阵,
为当地太阳矢量在地球坐标系的表示。
将***中的干扰进行分类,建立一类多源干扰SINS/GPS/偏振导航***误差新模型:
x(k+1)=Ax(k)+Bωn(k)+u(k)+B1ω1(k)+B2ω2(k)(2)
y(k)=Cx(k)+Dωn(k)+u(k)+D1ω1(k)+D2ω2(k)
其中,x(k)为***状态变量;A为***状态转移矩阵;ω(t)为惯性传感器漂移,近似描述为一阶马尔科夫过程、ω1(t)为高斯噪声,ω2(t)为范数有界干扰;B(t),B1(t),B2(t)分别为过程噪声矩阵,高斯噪声矩阵,范数有界干扰矩阵,C为***量测矩;D(t),D1(t),D2(t)分别为量测过程噪声矩阵和量测高斯噪声矩阵和范数有界干扰矩阵;控制输入u(k)用于标定和补偿。
所述步骤(3)中的干扰建模具体描述为:将惯性传感器漂移近似描述 为一阶马尔科夫过程,对于SINS模型误差、SINS机械振动、环境干扰等价描述为一范数有界干扰。
所述步骤(4)中的漂移估计器,所设计具体形式为:
其中,
为惯性传感器漂移ω
n(k)的估计值,K为所设计的漂移估计器的增益矩阵。y(k)为量测输出,
为量测输出的估计值。
所述步骤(5)中的H2/H∞混合滤波器,所设计具体形式为:
(4)
其中,
为状态x(k)的估计值,控制输
以及
用来标定和补偿传感器的漂移,矩阵L为待定的滤波器增益阵。
构造状态估计误差***,令
将***状态误差
与惯性传感器漂移估计误差
进行状态扩维,则估计误差***满足:
(5)
令新的状态为M,则
将H∞参考输出定义为:
将H2参考输出定义为
其中,C∞1,C∞2,C21,C22为选定的权矩阵。
将公式(6)(7)与估计误差***(5)联立得闭环***为:
其中:
通过MATLAB中的LMI工具箱求解滤波增益。
用多目标优化抗干扰滤波算法进行滤波。通过GPS输出对速度和位置进行校正,通过偏振传感器输出的偏振方位角对载体的姿态角进行校正。
本发明与现有技术相比的优点在于:本发明将SINS/GPS/偏振光导航***中的干扰进行了分类建模,不把干扰当成单一的高斯噪声,对于某些特性已知的干扰,可以充分利用其信息,分别采用干扰抵消和干扰抑制的方法,建立了一类同时具有干扰抵消与抑制性能的多目标优化抗干扰滤波方法的研究框架。可建模的干扰通过设计干扰观测器来抵消,设计鲁棒滤波器来抑制高斯噪声和能量有限的干扰。建立含有多源干扰的SINS/GPS/偏振光导航***误差新模型,并将多目标优化抗干扰滤波方法应用到SINS/GPS/偏振光的组合导航中,提高惯性导航***的精度和可靠性。
附图说明
图1为本发明的一种多目标优化抗干扰滤波算法流程图。
图2为本发明的一种多目标优化抗干扰滤波算法编排图。
具体实施方式
如图1所示,本发明的具体实施方法如下:
(1)SINS/GPS/偏振光组合导航***的数学模型的建立,包括***状态方程和量测方程,分别如式(9)和式(10)所示。
考虑飞行高度H并将地球视为旋转椭球体。
姿态误差方程为:
速度误差方程为:
位置误差方程为:
***状态方程:
其中,X(t)为***状态,X=[φE φN φU δVE δVN δVU δL δλ δh]T,φEφNφU为载体东向失准角、北向失准角以及天向失准角,δVEδVNδVU为载体东向速度误差、
北向速度误差以及天向速度误差,δLδλδh为纬度误差、经度误差以及高度误差。F(t)为***状态矩阵,ω(t)为惯性传感器漂移变量,
εbxεbyεbz为陀螺漂移, 为加速度计漂移,ω1(t)为高斯噪声,ω2(t)为范数有界干扰, 为载体系到导航系的姿态转换矩阵,B1(t),B2(t)为参数已知的矩阵。
***的量测方程
Z(t)=H(t)X(t)+D(t)ω(t)+D1(t)ω1(t)+D2(t)ω2(t) (13)
其中:Z为观测矢量,H为观测矩阵,η为量测噪声
Z=[δL δλ δh δVE δVN δVU δα]T
(2)多目标优化抗干扰滤波基本算法编排,该算法的流程图如图2所示。
a)构造干扰观测器:
b)根据漂移估计器,设计构造H2/H∞混合滤波器:
(15)
c)构造状态估计误差***,令
将***状 态误差
与惯性传感器漂移估计误差
进行状态扩维,则估计误差***满足:
(16)
令新的状态为M,则
d)将H∞参考输出定义为:
e)将H2参考输出定义为
其中,C∞1,C∞2,C21,C22为选定的权矩阵。
f)将公式(17)(18)与估计误差***(5)联立得闭环***为
7、输出位置,速度信息。
按照上述步骤1~6进行计算机仿真,建立导航***误差状态方程,量测方程,通过MATLAB中的LMI工具箱求解滤波增益,利用多目标优化抗干扰滤波算法即可完成对航天器的姿态、位置、速度估计。输出状态矢量X=[x y z vx vy vz]T的估计值
其中 分别是对航天器在X、Y、Z三个方向的位置和速度x,y,z,vx,vy,vz的估计;并输出估计方差矩阵 其中px,py,pz, 分别是航天器在X、Y、Z三个方向位置和速度的估计误差方差。
本发明说明书中未作详细描述的内容属于本领域专业技术人员公知的现有技术。