一种多源惯性导航信息合理性判别方法技术

本发明专利技术涉及一种多源惯性导航信息合理性判别方法，属于组合导航技术领域，具体涉及一种应用于惯性‑卫星组合导航技术领域，该方法能够在多套惯性导航信息解算单元配置情况下，对惯性导航信息的合理性进行判别和信息进行决策。本发明专利技术的方法通过对单拍数据进行有效性判别，以剔除出现故障的惯性解算单元发送的惯性导航信息，提高惯性导航信息的正确性；本发明专利技术的方法能够适应通信故障造成的惯性导航信息部分缺失现象，用通信正常的惯性导航信息进行组合导航计算，提高所使用的惯性导航信息的可靠性。

【技术实现步骤摘要】
201610177998

【技术保护点】
一种多源惯性导航信息合理性判别方法，其特征在于该方法的步骤为：(1)对由多个惯性解算单元输出的第一拍惯性导航信息进行第一拍数据有效性判别，该有效性判别包括惯性导航信息的整数型一致性比较和惯性导航信息的浮点数一致性比较；(2)步骤(1)中任意两个第一拍惯性导航信息整数型一致且浮点数一致，则认为此两个第一拍惯性导航信息一致，选取其中任意一个第一拍惯性导航信息作为组合导航输入的惯性导航信息；(3)对由多个惯性解算单元输出的第二拍惯性导航信息进行第二拍数据有效性判别，该有效性判别包括惯性导航信息的整数型一致性比较和惯性导航信息的浮点数一致性比较；(4)步骤(3)中任意两个第二拍惯性导航信息整数型一致且浮点数一致，则认为此两个第二拍惯性导航信息一致，选取其中任意一个第二拍惯性导航信息作为组合导航输入的惯性导航信息；(5)判断步骤(2)得到的第一拍惯性导航信息和步骤(4)得到的第二排惯性导航信息是否来自于同一个惯性解算单元，如果是来自于同一个惯性解算单元则进行步骤(6)，如果是来自于不同的惯性解算单元则认为惯性导航信息无效，结束本周期工作，等待进入下一个周期的工作；(6)首先由组合导航软件记录该起始时刻与第二拍惯性导航信息的时刻的时间间隔tgap，然后计算得到组合导航周期起始时刻处的惯性导航信息，即计算组合导航周期起始时刻惯性导航信息的惯性系位置、惯性系速度和载体系向惯性系坐标转换矩阵。...

【技术特征摘要】
1.一种多源惯性导航信息合理性判别方法，其特征在于该方法的步骤为：(1)对由多个惯性解算单元输出的第一拍惯性导航信息进行第一拍数据有效性判别，该有效性判别包括惯性导航信息的整数型一致性比较和惯性导航信息的浮点数一致性比较；(2)步骤(1)中任意两个第一拍惯性导航信息整数型一致且浮点数一致，则认为此两个第一拍惯性导航信息一致，选取其中任意一个第一拍惯性导航信息作为组合导航输入的惯性导航信息；(3)对由多个惯性解算单元输出的第二拍惯性导航信息进行第二拍数据有效性判别，该有效性判别包括惯性导航信息的整数型一致性比较和惯性导航信息的浮点数一致性比较；(4)步骤(3)中任意两个第二拍惯性导航信息整数型一致且浮点数一致，则认为此两个第二拍惯性导航信息一致，选取其中任意一个第二拍惯性导航信息作为组合导航输入的惯性导航信息；(5)判断步骤(2)得到的第一拍惯性导航信息和步骤(4)得到的第二排惯性导航信息是否来自于同一个惯性解算单元，如果是来自于同一个惯性解算单元则进行步骤(6)，如果是来自于不同的惯性解算单元则认为惯性导航信息无效，结束本周期工作，等待进入下一个周期的工作；(6)首先由组合导航软件记录该起始时刻与第二拍惯性导航信息的时刻的时间间隔tgap，然后计算得到组合导航周期起始时刻处的惯性导航信息，即计算组合导航周期起始时刻惯性导航信息的惯性系位置、惯性系速度和载体系向惯性系坐标转换矩阵。2.根据权利要求1所述的一种多源惯性导航信息合理性判别方法，其特征在于：组合导航软件录取时刻t1的惯性导航信息称为第一拍惯性导航信息，组合导航软件录取时刻t2的惯性导航信息称为第二拍惯性导航信息；第一拍惯性导航信息和第二拍惯性导航信息用于合理性判别和选择决策。3.根据权利要求1所述的一种多源惯性导航信息合理性判别方法，其特征在于：步骤(1)和步骤(3)中所述的惯性导航信息的整数型一致性比较是指：判别其中任意两个惯性导航信息的整数型一致，是指惯性导航信息传递的通讯正确，且惯性导航信息中的整数型信息相等。4.根据权利要求1所述的一种多源惯性导航信息合理性判别方法，其特征在于：步骤(1)和步骤(3)中所述的惯性导航信息的浮点数一致性比较是指：判别其中任意两个惯性导航信息的浮点数一致，是指惯性导航信息的速度和位置信息满足如下公式：且(Vx_m-Vx_n)2+(Vy_m-Vy_n)2+(Vz_m-Vz_n)2≤ϵinsv]]>式中，(xm,ym,zm)表示任意两个惯性导航信息中的一个惯性导航信息中的惯性系位置，(Vx_m,Vy_m,Vz_m)表示任意两个惯性导航信息中的一个惯性导航信息中的惯性系速度，(xn,yn,zn)表示任意两个惯性导航信息中的另一个惯性导航信息中的惯性系位置，(Vx_n,Vy_n,Vz_n)表示任意两个惯性导航信息中的另一个惯性导航信息中的惯性系速度；εinsp为惯性系位置一致性门限，εinsv为惯性系速度一致性门限。5.根据权利要求1所述的一种多源惯性导航信息合理性判别方法，其特征在于：步骤(2)中选取第一拍惯性导航信息作为组合导航输入的惯性导航信息时，以得到的第一拍惯性导航信息一致性最多的作为组合导航的输入。6.根据权利要求5所述的一种多源惯性导航信息合理性判别方法，其特征在于：作为一致性最多的惯性导航信息有两个以上时，按照惯性解算单元的逻辑编号从前往后选取。7.根据权利要求1所述的一种多源惯性导航信息合理性判别方法，其特征在于：所述的步骤(6)中组合导航周期起始时刻处的惯性导航信息的惯性系
\t位置的计算方法为：x=xa+Kr·(xb-xa)y=ya+Kr·(yb-ya)z=za+Kr&CenterD...

【专利技术属性】
技术研发人员：尚腾，徐帆，曹洁，巩庆海，李学锋，王辉，张宇，
申请(专利权)人：北京航天自动控制研究所，中国运载火箭技术研究院，
类型：发明
国别省市：北京;11