[发明专利]一种SINS/GPS/偏振光组合导航系统多目标优化抗干扰滤波方法

摘要

本发明涉及一种SINS/GPS/偏振光组合导航系统多目标优化抗干扰滤波方法，涉及无人机、舰船、车辆、等地球大气层内运载体的SINS/GPS/偏振光组合导航系统多目标优化抗干扰滤波方法。其特征是将SINS、GPS、偏振传感器以及环境中的干扰进行分类，对不同类型的干扰进行干扰建模，可建模干扰通过设计干扰观测器来抵消，高斯随机变量通过H2优化技术来抑制，范数有界未知变量通过H∞优化技术来抑制。本发明充分利用了SINS/GPS/偏振光组合导航系统中干扰的特性，通过设计干扰观测器的方法以及鲁棒技术对干扰进行干扰抵消和干扰抑制，可用于提高地球大气层内运载体的导航精度。

主权项

一种SINS/GPS/偏振光组合导航系统多目标优化抗干扰滤波方法，其特征包括以下步骤：(1)建立以偏振方位角α为量测量的量测方程；(2)充分利用干扰特性，建立基于失准角速度v、位置p为状态的状态方程以及基于速度v、位置p以及偏振方位角α为量测量的量测方程，并将状态方程和量测方程离散化；(3)对系统的干扰进行分类，对不同类型的干扰进行干扰建模；(4)设计漂移估计器估计并抵消可建模干扰，通过H2优化技术抑制高斯噪声；(5)根据设计的漂移估计器，构造H2/H∞混合滤波器，通过H∞优化技术来抑制范数有界干扰；(6)根据设计的漂移估计器以及混合鲁棒滤波器，构造状态估计误差系统，设计多目标优化抗干扰滤波算法，构造状态估计误差系统，用多目标优化抗干扰滤波算法对所述H2/H∞混合滤波器进行集中式滤波，并输出导航信息；所述的步骤(1)中基于偏振方位角α为量测量的量测方程中的量测量为：Zp=A2CbmCn′bCen′aoseA1CbmCn′bCen′aose-A2CbmCn′b(I-Φ×+δθ×)Cen′aoseA1CbmCn′b(I-Φ×+δθ×)Cen′aose---(1)]]>其中，为载体坐标系到偏振模块坐标系的姿态转换矩阵，为导航系和载体系之间姿态转移矩阵的名义值，为地理系和导航系之间姿态转移矩阵的名义值，Φ×为姿态角的反对称矩阵，δθ×为[δλsinLδλcosLδL]的反对称矩阵，为导航坐标系到载体坐标系的姿态转换矩阵，为地球坐标系到导航坐标系的姿态转换矩阵，为当地太阳矢量在地球坐标系的表示；将系统中的干扰进行分类，建立一类多源干扰SINS/GPS/偏振导航系统误差新模型：x(k+1)=Ax(k)+Bωn(k)+u(k)+B1ω1(k)+B2ω2(k)y(k)=Cx(k)+Dωn(k)+u(k)+D1ω1(k)+D2ω2(k)---(2)]]>其中，x(k)为系统状态变量；A为系统状态转移矩阵；ωn(k)为惯性传感器漂移，近似描述为一阶马尔科夫过程、ω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+1)=Wω^n(k)+K[y(k)-y^(k)]---(3)]]>其中，为惯性传感器漂移ωn(k)的估计值，K为所设计的漂移估计器的增益矩阵；y(k)为量测输出，为量测输出的估计值；所述步骤(5)中的H2/H∞混合滤波器，所设计具体形式为：x~(k+1)=Ax~(k)+u(k)+uc1(k)+L[y(k)-y^(k)]y^(k+1)=Hx~(k)+u(k)+uc2(k)---(4)]]>其中，为状态x(k)的估计值，控制输以及用来标定和补偿传感器的漂移，矩阵L为待定的滤波器增益阵；构造状态估计误差系统，令将系统状态误差与惯性传感器漂移估计误差进行状态扩维，则估计误差系统满足：x~(k+1)=(A-LC)x~(k)+(B-LD)ω~n(k)+(B1-LD1)ω1(k)+(B2-LD2)ω2(k)ω~n(k+1)=(W-KD)ω~n(k)-KCx~(k)+(B3-KD1)ω1(k)-KD2ω2(k)---(5)]]>令新的状态为M，则 将H∞参考输出定义为：z∞(k)=C∞1x~(k)+C∞2ω~n(k)---(6)]]> 将H2参考输出定义为z2(k)=C21x~(k)+C22ω~n(k)---(7)]]>其中，C∞1,C∞2,C21,C22为选定的权矩阵；将公式(6)和(7)与公式(5)联立得闭环系统为：x~(k+1)ω~n(k+1)=A‾x~(k)ω~n(k)+B‾1ω1(k)+B‾2ω2(k)]]>z∞(k)=C‾∞(k)x~(k)ω~n(k)---(8)]]>z2(k)=C‾2(k)x~(k)ω~n(k)]]> 其中：A‾=A-LCB-LD-KCW-KD,B‾1=B1-LD1B3-KD1,B‾2=B2-LD2-KD2]]>C‾∞(k)=C∞1C∞2,C‾2(k)=C21C22]]>通过MATLAB中的LMI工具箱求解滤波增益用多目标优化抗干扰滤波算法进行滤波；通过GPS输出对速度和位置进行校正，通过偏振传感器输出的偏振方位角对载体的姿态角进行校正。