本发明属于惯性导航技术领域，特别涉及了一种动基座初始对准方法。
背景技术：
对于采用gnss/ins组合导航的运载体，如果能充分利用组合导航系统中gnss的信息对惯性导航系统进行初始化，则可以减小系统对载体的依赖，实现自主对准。由于载体任务、环境的不同，往往需要在不同的机动下完成初始对准：某些系统如瞄准吊舱系统初始对准需要在地面启动或起飞阶段实现，机动方式受到严格限制；某些系统(如飞行器)若在航行中发生故障需要重启，便需要在空中高动态飞行条件下完成初始对准。在低机动情况下，收敛速度较快，但是方位失准角可观测度较低，导致方位失准角的对准精度较低；在高机动情况下，方位失准角可观测性得到提高，但机动运动同时也会影响系统的线性，对数据融合滤波器(如卡尔曼滤波器)的估计效果产生一定的负面影响，对准的快速性和精度受到影响。如何综合提高载机各种机动情况下的对准精度和快速性，是初始对准领域亟需解决的问题。
运动学约束辅助导航是一种新型的飞行器导航方法，它通过将飞行器的运动信息与现有的导航系统信息相融合，来有效提高导航系统的导航精度与可靠性。该方法无需增加额外的传感器，具有自主性强、成本低和零载重等优点。dissanayake等针对低精度ins/gnss组合系统，提出了运动约束的思想，即当载体在地面上运动且没有侧滑时，载体侧向和垂向速度为0。目前运动学约束辅助导航的研究多针对载体在地面运动的情况，但是空中飞行的飞机，由于迎角和侧滑角的存在，即使在飞机直线飞行的情况下，机体坐标系的侧向和垂向速度也不为零，地面运动中的速度约束、高度约束等条件在空中均不再适用。
技术实现要素：
为了解决上述背景技术提到的技术问题，本发明提出了一种捷联惯性导航系统空中动基座初始对准方法。
为了实现上述技术目的，本发明的技术方案为：
一种捷联惯性导航系统空中动基座初始对准方法，包括以下步骤：
(1)基于捷联惯性导航系统解算速度与gnss测量速度的差值作为一组量测量建立速度量测方程；
(2)建立飞行器的角运动约束模型，基于捷联惯性导航系统解算的角速度建立角速度虚拟量测方程，并在飞行器空中运动过程中，对角运动模式进行实时判别，实时判断出其是否处于非角运动状态；
(3)当检测到飞行器处于非角运动状态时，引入步骤(2)建立的角速度约束模型，将步骤(2)中的角速度虚拟量测方程联合步骤(1)中的速度量测方程进行量测更新；当检测到飞行器处于角运动状态时，仅采用步骤(1)中的速度量测方程进行量测更新。
进一步地，在步骤(1)中，所述速度量测方程如下：
其中，zv(t)为速度量测量，vie、vin、viu为捷联惯性导航系统解算的导航坐标系各轴的速度，δve、δvn、δvu为捷联光写导航系统的速度误差，vge、vgn、vgu为gnss测量的导航坐标系各轴的速度，me、mn、mu为gnss接收机的测速误差，hv(t)为量测系数矩阵，x(t)为捷联惯性导航系统的状态向量，vv(t)为量测噪声向量。
进一步地，在步骤(2)中，飞机的角运动约束模型如下：
其中，
进一步地，在步骤(2)中，所述虚拟量测方程如下：
其中，zω(t)为角速度量测量，
进一步地，所述量测系数矩阵hω(t)的具体形式如下：
其中：
01×10表示1×10的零矩阵，
进一步地，在步骤(2)中，所述角运动模式判别方法如下：
(1)在角速度虚拟量测方程中，计算实际角速度量测值与预测角速度量测值之间的残差rω,k；
(2)计算方差
(3)构建模式检测函数：
设定阈值td，当λω,k＜td时，则判定飞行器处于非角运动状态；当λω,k≥td时，则判定飞行器处于角运动状态。
采用上述技术方案带来的有益效果：
1、本发明基于飞行器的角运动约束模型，进行运动模式判别，构造虚拟量测方程辅助gnss进行空中动基座对准。在载体低机动情况下提高动基座对准的精度，在载体高机动情况下提高动基座对准的快速性，满足各种机动情况下的机载捷联惯性导航系统空中对准精度、快速性等综合需求。在gnss失效时，本发明也可有效地抑制惯性导航系统的发散趋势，提高导航精度。
2、本发明中不需要增加额外设备，具有使用成本低、自主性强等特点，是一种较好的利用载体运动学信息进行空中动基座对准的方法。
附图说明
图1是本发明的方法流程图。
具体实施方式
以下将结合附图，对本发明的技术方案进行详细说明。
一种捷联惯性导航系统空中动基座初始对准方法，如图1所示，包括以下步骤：
步骤1：基于捷联惯性导航系统解算速度与gnss测量速度的差值作为一组量测量建立速度量测方程；
步骤2：建立飞行器的角运动约束模型，基于捷联惯性导航系统解算的角速度建立角速度虚拟量测方程，并在飞行器空中运动过程中，对角运动模式进行实时判别，实时判断出其是否处于非角运动状态；
步骤3：当检测到飞行器处于非角运动状态时，引入步骤2建立的角速度约束模型，将步骤2中的角速度虚拟量测方程联合步骤1中的速度量测方程进行量测更新；当检测到飞行器处于角运动状态时，仅采用步骤1中的速度量测方程进行量测更新。
在本实施例中，上述步骤可以采用如下优选方案实现：
首先选取捷联惯导系统的数学平台失准角φe、φn、φu，速度误差δve、δvn、δvu，陀螺随机常值漂移εbx、εby、εbz，陀螺一阶马尔可夫过程εrx、εry、εrz，加速度计一阶马尔可夫过程
则状态方程为：
上式中，x(t)为状态向量；a(t)为状态转移矩阵；g(t)为系统噪声系数矩阵；w(t)为系统噪声向量。
惯性导航系统的速度信息vi＝[vievinviu]和gnss的速度信息vg＝[vgevgnvgu]可分别表示为：
上式中，ve0、vn0、vu0是飞行器沿导航坐标系各轴的真实速度；δve、δvn、δvu是惯性导航系统解算的速度误差；me、mn、mu为gnss接收机测速误差，可视为白噪声。
则速度量测方程为：
上式中，hv(t)＝[03×3diag[111]03×9]为量测系数矩阵，03×3为3×3的零矩阵，03×9为3×9的零矩阵，vv(t)为量测噪声向量，近似为白噪声。
建立飞行器的角运动约束模型，具体为：根据陀螺仪的实际输出，借助计算坐标系c系，c系相对n系存在数学平台失准角φ＝[φeφnφu]t，其中φe、φn、φu分别东向、北向和天向平台失准角，该坐标系表示带有计算误差的计算导航坐标系。推导得出机体坐标系下的角速度误差
由陀螺仪输出角速度：
其中，
对等式两端取导数，但等式右端不能直接进行求导，需借助计算坐标系c。c系相对n系存在数学平台失准角φ＝[φeφnφu]t，其中φe、φn、φu分别东向、北向和天向平台失准角，该坐标系表示带有计算误差的计算导航坐标系。
从而得到：
其中，
c系相对n系的失准角φ通常是一个小角度，故可以采用一阶近似。则可以推导求得：
其中
将式(6)带入式(5)，可展开为：
将式(4)带入式(7)，对比等式两边的变量，并忽略二阶小量可得：
又因为
将
当载体处于非角运动状态时，地球自转和载体在地球表面运动所产生的角速度分量量级较小，可认为机体坐标系相对于导航坐标系的角速度
则可通过式(9)构建运动约束虚拟量测方程，如式(10)所示。
上式中，
其中，
对角运动模式进行实时判别，具体为：
a、角速度虚拟量测方程(10)中，实际量测值zω,k与量测预测值
其中，hω,k为k时刻的量测系数矩阵，xk为k时刻的状态向量，vω,k为k时刻的量测噪声向量，
飞机角运动带来的实际角速度将通过量测残差向量对滤波器产生很大影响，甚至导致滤波发散。其方差为：
其中pk/k-1为一步预测均方误差阵，rω,k为k时刻的量测噪声方差阵。
当飞机直线运动时，残差rω,k较小，当飞机姿态发生变化时，残差rω,k急剧增大。因此，通过对残差rω,k的均值进行检验即可判别飞机的角运动模式。
b、构建模式检测函数：
对飞机的角运动数据进行预分析，选择适当的阈值td，当λω,k＜td时，则判定飞机处于非角运动状态，运动约束有效，引入角速度约束模型，捷联惯性导航系统解算的角速度作为虚拟量测信息，联合步骤1中gnss信息进行量测更新；当λω,k≥td时，则判定飞机处于角运动状态时，运动约束无效，仅采用步骤1中gnss信息进行量测更新。
根据步骤3中角运动模式判别的结果，当检测到飞机在直线飞行模式，引入角速度约束模型，捷联惯性导航系统解算的角速度作为虚拟量测信息，联合步骤1中gnss信息进行量测更新：式(3)和式(10)构成共同量测方程，利用zv(t)和zω(t)进行量测更新，联合式(1)状态方程，通过滤波器即可对状态量进行滤波估计，精确估算出惯性导航系统初始姿态误差角，从而实现高精度的空中动基座对准。当检测到飞机不是直线飞行模式，则仅采用步骤1中gnss信息进行量测更新，将式(3)作为量测方程，联合式(1)状态方程，通过滤波器即可对状态量进行滤波估计，估算出惯性导航系统初始姿态误差角。
实施例仅为说明本发明的技术思想，不能以此限定本发明的保护范围，凡是按照本发明提出的技术思想，在技术方案基础上所做的任何改动，均落入本发明保护范围之内。
1.一种捷联惯性导航系统空中动基座初始对准方法，其特征在于，包括以下步骤：
(1)基于捷联惯性导航系统解算速度与gnss测量速度的差值作为一组量测量建立速度量测方程；
(2)建立飞行器的角运动约束模型，基于捷联惯性导航系统解算的角速度建立角速度虚拟量测方程，并在飞行器空中运动过程中，对角运动模式进行实时判别，实时判断出其是否处于非角运动状态；
(3)当检测到飞行器处于非角运动状态时，引入步骤(2)建立的角速度约束模型，将步骤(2)中的角速度虚拟量测方程联合步骤(1)中的速度量测方程进行量测更新；当检测到飞行器处于角运动状态时，仅采用步骤(1)中的速度量测方程进行量测更新。
2.根据权利要求1所述捷联惯性导航系统空中动基座初始对准方法，其特征在于，在步骤(1)中，所述速度量测方程如下：
其中，zv(t)为速度量测量，vie、vin、viu为捷联惯性导航系统解算的导航坐标系各轴的速度，δve、δvn、δvu为捷联光写导航系统的速度误差，vge、vgn、vgu为gnss测量的导航坐标系各轴的速度，me、mn、mu为gnss接收机的测速误差，hv(t)为量测系数矩阵，x(t)为捷联惯性导航系统的状态向量，vv(t)为量测噪声向量。
3.根据权利要求1所述捷联惯性导航系统空中动基座初始对准方法，其特征在于，在步骤(2)中，飞机的角运动约束模型如下：
其中，
4.根据权利要求1所述捷联惯性导航系统空中动基座初始对准方法，其特征在于，在步骤(2)中，所述虚拟量测方程如下：
其中，zω(t)为角速度量测量，
5.根据权利要求4所述捷联惯性导航系统空中动基座初始对准方法，其特征在于，所述量测系数矩阵hω(t)的具体形式如下：
其中：
01×10表示1×10的零矩阵，
6.根据权利要求4所述捷联惯性导航系统空中动基座初始对准方法，其特征在于，在步骤(2)中，所述角运动模式判别方法如下：
(1)在角速度虚拟量测方程中，计算实际角速度量测值与预测角速度量测值之间的残差rω,k；
(2)计算方差
(3)构建模式检测函数：
设定阈值td，当λω,k＜td时，则判定飞行器处于非角运动状态；当λω,k≥td时，则判定飞行器处于角运动状态。
技术总结