[发明专利]一种惯性/卫星组合导航系统开闭环混合修正方法

摘要

本发明属于导航技术领域，涉及一种惯性/卫星组合导航系统开闭环混合修正方法。本发明采用开闭环修正结合的方法对惯性卫星导航系统的误差量进行修正。在闭环修正中采用了自适应获得卡尔曼滤波器量测噪声方差值的方法，方法简便易行、实施难度较小，可有效抑制卫星导航数据的跳变异常、以及长时间不组合后进入组合状态时修正量的较大波动，提高了闭环修正的准确性和稳定性；在开环修正中对所采集的量测量实行每秒实时更新，修正频率与惯导数据总线频率相同，不同频率的闭环和开环修正采用按卫星导航接收机秒脉冲同步的方法，做到了无缝连接，误差修正迅捷且平滑，解决了闭环修正容易干扰开环修正的难题。

主权项

一种惯性/卫星组合导航系统开闭环混合修正方法，其特征是，1)自适应获得卡尔曼滤波器量测噪声方差值在惯性/卫星组合导航系统中预先设定的量测噪声固定方差值为R01，R02，...R0m，卡尔曼滤波器已获得的量测值为Z1，Z2，...Zm，卡尔曼滤波器已获得的与量测值对应的估计均方误差阵P中对应的对角线元素为PL1，PL2，...PLm，待计算的量测噪声方差值为R1，R2，...Rm，一个闭环修正周期内的新闭环修正值为SB1，SB2，...SBM，预置闭环修正量状态字A的初始值为0，预置闭环修正计时器B的初始值为0。获得量测噪声方差值的步骤如下：①等待和判断卫星接收机秒脉冲是否在0.9s～1.1s内到。如果是，则转入下一步；如果否，则卫星接收机出现故障，停止组合导航，转入纯惯性导航；②等待和判断在卫星接收机秒脉冲到来后的950m内卫星导航数据包是否到。如果是，则转入下一步；如果到950ms数据包一直未到，则按照惯导输出数据总线周期作时间更新，B＝B+1，转到①；③判断是否满足闭环修正的卫星状态字有效和闭环修正周期秒数的条件。如果满足，则转入下一步；如果不满足，则按照惯导输出数据总线周期作时间更新，B＝B+1，转到①；④使得|Z1|2与PL1的单位相同、|Z2|2与PL2的单位相同、…|Zm|2与PLm的单位相同；⑤分别判断量测值和估计均方误差阵P中对应的对角线元素，获得量测噪声方差值：是否|Z1|2/PL1≤1。如果是，则R1＝R10；如果否，则R1＝R10*|Z1|2/PL1。是否|Z2|2/PL2≤1。如果是，则R2＝R20；如果否，则R2＝R20*|Z2|2/PL2。…是否|Zm|2/PLm≤1。如果是，则Rm＝Rm0；如果否，则Rm＝Rm0*|Zm|2/PLm。⑥将量测噪声方差值R1，R2，...Rm置于卡尔曼滤波器中处理，获得本闭环修正周期内的闭环修正量SB1，SB2，...SBM，闭环修正量状态字A＝1，同时闭环修正计时器B自动累加1；⑦重复①‑⑥步骤。2)开环修正量更新在惯性/卫星组合导航系统中设定按秒脉冲更新的初始更新开环修正量是S1、S2、…SK，实际更新开环修正量SS1、SS2、…SSK，累积的开环修正总量是LS1、LS2、…LSK，初始值均为0，预先设置开环修正系数a，a大于0并小于惯导数据总线频率的倒数。开环修正量更新的步骤如下：(1)、等待和判断卫星接收机秒脉冲是否在0.9s～1.1s内到。如果是，则转入下一步；如果否，分为两种情况：如果秒脉冲未到，但还未结束0.9s～1.1s的时间遍历，则转到(10)，做开环修正量固定值的累加；如果已结束0.9s～1.1s的时间遍历，秒脉冲仍未到，则卫星接收机出现故障，停止组合导航，转入纯惯性导航；(2)、锁定惯性/卫星组合导航系统上的卫星接收机秒脉冲到来时刻的惯导没有经过开环修正的相应数据Ins1，Ins2，...InsK，并存储到惯性/卫星组合导航系统上的内存单元中；(3)、等待和判断在卫星接收机秒脉冲到来后的950m内卫星导航数据包是否到。如果是，则转入下一步；如果到950ms数据包一直未到，则停止开环修正量累加，按照惯导输出数据总线周期作时间更新，B＝B+1，转到(1)；如果还未到950ms且数据包一直未到，则转到(10)；(4)、根据卫星导航数据包的状态字判断卫星导航数据是否可用。如果是，则进入下一步；如果否，则停止开环修正量累加，按照惯导输出数据总线周期作时间更新，B＝B+1，转到(1)；(5)、在惯性/卫星组合导航系统中的卫星接收机秒脉冲对应卫星导航数据包到来时，从数据包中取出卫星导航的对应数据Sat1，Sat2，...SatK；(6)、根据取出的卫星导航对应数据和存储的惯导对应数据，计算初始开环修正量S1、S2、…SK，S1＝Ins1‑Sat1，S2＝Ins2‑Sat2，…SK＝InsK‑SatK；(7)、判断状态字A是否为1且闭环修正计时器B是否小于300秒；(8)、如果是，就从开环修正量S1、S2、…SK先减去当前时刻的累积开环修正量LS1、LS2、…LSK，再减去即将使用的闭环修正量SB1，SB2，...SBM中与开环修正量相对应的量SB1，SB2，...SBK，得到新的开环修正量SS1、SS2、…SSK；计算出本时刻开始的实际开环修正量a*SS1、a*SS2、…、a*SSK；用开环修正量a*SS1、a*SS2、…、a*SSK和闭环修正量SB1，SB2，...SBK同时做开环和闭环修正，实际上是把开环修正量a*SS1、a*SS2、…、a*SSK分别累加到累积开环修正量LS1、LS2、…LSK中，持续用累积开环修正量LS1、LS2、…LSK对惯导的相应输出数据分别作开环修正，并置A＝0，B＝0；(9)、如果否，则只从量测数据中减去当前时刻的累积开环修正量LS1、LS2、…LSK，得到新的开环修正量SS1、SS2、…SSK；计算出本时刻开始的实际开环修正量a*SS1、a*SS2、…、a*SSK；只用开环修正量a*SS1、a*SS2、…、a*SSK做开环修正，实际上是把开环修正量a*SS1、a*SS2、…、a*SSK分别累加到累积开环修正量LS1、LS2、…LSK中，持续用累积开环修正量LS1、LS2、…LSK对惯导的相应输出数据分别作开环修正，并置B＝B+1；(10)、按照惯导输出数据总线周期作时间更新，再次将开环修正量a*SS1、a*SS2、…、a*SSK分别累加到累积开环修正量LS1、LS2、…LSK中，持续用累积开环修正量LS1、LS2、…LSK对惯导的相应输出数据分别作开环修正；(11)、回到(1)。