CN112033441B - 用于bds/mems组合导航下的联动编队完好性监测方法 - Google Patents

用于bds/mems组合导航下的联动编队完好性监测方法 Download PDF

Info

Publication number
CN112033441B
CN112033441B CN202010951297.5A CN202010951297A CN112033441B CN 112033441 B CN112033441 B CN 112033441B CN 202010951297 A CN202010951297 A CN 202010951297A CN 112033441 B CN112033441 B CN 112033441B
Authority
CN
China
Prior art keywords
fault
linkage
integrity
bds
mems
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Active
Application number
CN202010951297.5A
Other languages
English (en)
Other versions
CN112033441A (zh
Inventor
吴云
唐卫明
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Wuhan University WHU
Original Assignee
Wuhan University WHU
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Wuhan University WHU filed Critical Wuhan University WHU
Priority to CN202010951297.5A priority Critical patent/CN112033441B/zh
Publication of CN112033441A publication Critical patent/CN112033441A/zh
Application granted granted Critical
Publication of CN112033441B publication Critical patent/CN112033441B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C25/00Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S19/00Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
    • G01S19/01Satellite radio beacon positioning systems transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
    • G01S19/13Receivers
    • G01S19/20Integrity monitoring, fault detection or fault isolation of space segment
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S19/00Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
    • G01S19/01Satellite radio beacon positioning systems transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
    • G01S19/13Receivers
    • G01S19/23Testing, monitoring, correcting or calibrating of receiver elements

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Computer Networks & Wireless Communication (AREA)
  • Computer Security & Cryptography (AREA)
  • Manufacturing & Machinery (AREA)
  • Position Fixing By Use Of Radio Waves (AREA)

Abstract

本发明公开了一种用于BDS/MEMS组合导航下的联动编队完好性监测方法,对BDS/MEMS组合导航下的联动目标相对定位进行自主完好性监测。首先,本方法考虑所有导致联动目标导航中断和误导的风险,将连续性风险和完好性风险进行合理分配;然后,根据连续性风险对联动目标的相对定位进行故障检测和排除;最后,根据完好性风险严密计算相对定位的保护水平,当相对定位保护水平不能满足安全距离限值时,实时向用户报警。本发明可为联动目标相对定位提供可信监测,避免联动目标在作业时发生相互碰撞,从而为联动目标编队的作业提供了安全保障。

Description

用于BDS/MEMS组合导航下的联动编队完好性监测方法
技术领域
本发明涉及北斗导航系统(BDS)领域以及北斗卫星导航和惯性导航系统(INS)的组合定位领域,提出一种用于联动目标编队相对定位的自主完好性监测方法。
背景技术
联动目标编队是由数十个、甚至数百个无人机、车辆或舰船等移动目标组成,编队中的移动目标像蜜蜂一样分工协同运行。移动目标以自身位置为中心,按照预定的路线行驶,与其它目标之间通过无线通信网络进行连接,自主解算与其它目标之间的相对位置,并自动调整相互之间的安全距离。联动目标编队不仅用于军事领域的无人机蜂群、舰船编队和车辆编队的协同侦查和作战,在国民生活领域中也有广泛的应用前景,如用于营救、环境监测和智能交通系统车辆队列的安全行驶和管理等领域。
在联动目标编队作业时,目标间精确、可信的实时相对位置是安全有效且协同工作的前提。在相对定位技术中,由于BDS导航系统不仅可以全天候高效作业,而且可获得厘米级的相对定位结果,在国民生活和生产建设领域有着广泛的应用。将BDS与INS组合,可以有效地克服BDS易受环境影响和INS误差随时间积累的缺陷,为联动目标提供更稳定可靠的高精度相对定位结果。随着多频多系统BDS的发展,BDS/INS组合导航研究取得了丰硕的成果,并得到了广泛的应用,但在人们普遍关注定位精度的同时却忽视了其完好性能。目前虽然有研究人员对定位结果进行故障检测、剔除和可靠性分析,但却没有考虑用户定位结果的完好性风险,也没有实施严密的完好性监测,因此用户对导航定位结果的可信程度一无所知。由于缺乏系统和成熟的完好性监测技术,联动目标间的安全距离无法保障,这给联动目标编队作业,尤其在复杂环境下作业带来了安全隐患。
发明内容
本发明将为BDS/MEMS组合导航的联动目标提供自主完好性监测,监测内容包括检测和剔除BDS/MEMS组合导航系统中的故障;根据完好性风险和连续性风险计算联动目标之间的平面和高程方向的保护水平;当故障不能排除或者保护水平不能满足告警限值的要求时,实时向用户报警。本发明为联动目标相对定位提供可信监测,避免联动目标相互碰撞的发生,从而为联动目标编队的安全作业提供了保障。
本发明提供一种用于BDS/MEMS组合导航下的联动编队完好性监测方法,包括以下步骤:
步骤1,将连续性风险和完好性风险指标在导航系统和非导航系统间分配,非导航系统风险指由导航和通讯硬件设备故障、信号被干扰和通讯中断带来的风险。
步骤2,利用基于BDS/MEMS组合导航的联动目标相对定位解算结果构建用于完好性监测的数学模型;
步骤3,根据多故障假设,考虑所有可能存在的导航风险,构建联动目标相对定位多故障假设Hi(k=0,1,2…);根据先验完好性信息,确定需要被完好性监测的故障状态;
步骤4,基于多故障假设计算联动目标相对定位的分离解
Figure GDA0002738290900000021
和分离解差异
Figure GDA0002738290900000022
以及它们的方差
Figure GDA0002738290900000023
Figure GDA0002738290900000024
步骤5,根据连续性风险对BDS/MEMS相对定位观测值进行故障检测和排除;
步骤6,根据完好性风险计算联动目标相对定位在平面和高程方向的保护水平;
步骤7,将平面和高程方向的保护水平与安全限值比较,判断保护水平是否能够满足安全限值要求,并向用户发出安全或告警的指令。
在上述的自主完好性监测中,所述步骤1的风险分配具体如下:
步骤1.1,首先将连续性风险PCONT在导航系统和非导航系统间分配,分配于导航系统和非导航系统的连续性风险分别为PFA和PCONT_facility
步骤1.2,将完好性风险在导航系统和非导航系统间分配,分配于导航系统和非导航系统的完好性风险分别为PHMI_NAV和PHMI_facility
步骤1.3,将分配于导航系统的完好性风险PHMI_NAV在被监测的故障状态和不被监测的故障假设状态间分配,分别为PHMI_M和PHMI_UnM;
步骤1.4,将完好性风险PHMI_NAV在联动目标相对定位结果的东、北和天(E、N和U)方向上分配,分别为PHMI_E、PHMI_N和PHMI_U
在一种用于BDS/MEMS组合导航下的联动编队完好性监测方法中,步骤2的具体实现方法如下:
步骤2.1,利用BDS/MEMS组合导航联动目标相对定位结果重建观测方程
Figure GDA0002738290900000031
其中
Figure GDA0002738290900000032
U为将两动点MEMS传感器获得的历元间基线向量的变化信息;
Figure GDA0002738290900000033
为上个历元联动目标相对定位结果;Lt是将解算模糊度固定解或浮点解恢复后得到的BDS相位双差观测值;
步骤2.2,确定观测方程的先验随机模型,其中MEMS基线观测值
Figure GDA0002738290900000034
的方程
Figure GDA0002738290900000035
通过以下方法得到
Figure GDA0002738290900000036
上式中
Figure GDA0002738290900000037
Figure GDA0002738290900000038
的方差;DU为U的方差;Lt的方差DLt由以下方法得到
Figure GDA0002738290900000039
其中
Figure GDA00027382909000000310
为BDS相位双差观测值的方差;
Figure GDA00027382909000000311
为模糊度浮点解的方差,若当模糊度固定时
Figure GDA00027382909000000312
为零。
步骤2.3综合考虑BDS空间信号故障、两动点的信号在传播过程中被干扰、基线解算中整周模糊的固定错误等因素造成的故障,确定联动目标基线观测值的先验故障概率PBDSi;MEMS工作相对稳定,不受环境影响,这里PMEMS取经验值。
在一种用于BDS/MEMS组合导航下的联动编队完好性监测方法中,步骤3的具体实现方法如下:
步骤3.1,建立基线观测值无故障假设H0,任意一个基线观测值故障假设和任意两个观测值故障假设状态等Hi(1,2…),确定相应的故障假设中健康观测值集合idxi
步骤3.2,根据BDS/MEMS先验故障概率确定P(Hk),P(Hk)的计算方法如下:
无故障假设状态H0发生的概率为
Figure GDA0002738290900000041
其中n为观测值的个数,Pi为在步骤2.3中确定的观测值先验故障概率;任意一个传感器s发生故障且其它传感器无故障的假设为Hk,Hk发生的概率概率为
Figure GDA0002738290900000042
其中Pi为在步骤2.3中确定的基线先验故障概率;
步骤3.3;将故障状态概率P(Hk)从大到小排序,并从大概率开始累加故障假设状态概率,当
Figure GDA0002738290900000043
即停止累加,被累加的Hi(i=0,1,2…k)即为需要被监测的故障假设状态;
在一种用于BDS/MEMS组合导航下的联动编队完好性监测方法中,步骤4的具体实现方法如下:
步骤4.1,计算各个故障假设状态的分离解
Figure GDA0002738290900000044
计算方法如下
Figure GDA0002738290900000051
其中z为BDS/MEMS联动目标基线观测值;S(i)为观测值到分离解的映射矩阵;
Figure GDA0002738290900000052
的方差计算如下
Figure GDA0002738290900000053
步骤4.2计算分离解差异
Figure GDA0002738290900000054
计算方法如下
Figure GDA0002738290900000055
Figure GDA0002738290900000056
的方差计算如下
Figure GDA0002738290900000057
在一种用于BDS/MEMS组合导航下的联动编队完好性监测方法中,步骤5的具体实现方法如下:
步骤5.1,对故障进行检测,如果
Figure GDA0002738290900000058
则接受无故障假设状态H0的假设,否则进入步骤5.2;其中
Figure GDA0002738290900000059
为服从χ2分布的的故障假设检验量;
Figure GDA00027382909000000510
Figure GDA00027382909000000511
F-1表示χ2分布的反函数;PFA为在步骤1.1中分配的连续性风险;n为观测值的个数;m为基线解算中的为未知参数的个数。
步骤5.2,别逐一对故障假设Hi(i=1,2…k)建立假设检验量
Figure GDA00027382909000000512
Figure GDA00027382909000000513
并且Hi中的观测值最多,Hi即为被识别的故障,这时进入步骤6;如果没有满足上述条件的Hi,表明故障无法识别,进入步骤5.3;
步骤5.3,在步骤5.2中,若故障无法被识别,这时的保护水平标记为HPL=999,VPL=999,表示系统不能满足完好性要求。
在一种用于BDS/MEMS组合导航下的联动编队完好性监测方法中,步骤6的具体实现方法如下:
步骤6.1,计算每一个被监测的故障假设Hi(i=0,1,2…k)的保护水平,如在故障假设下U方向的保护水平计算如下
Figure GDA0002738290900000061
其中
Figure GDA0002738290900000062
Figure GDA0002738290900000063
Figure GDA0002738290900000064
分别为步骤4.1和步骤4.2中的
Figure GDA0002738290900000065
Figure GDA0002738290900000066
在U方向的方差分量
步骤6.2,E和N方向的保护水平EPLi和NPLi的计算与U方向的计算方法类同;平面方向的保护水平计算方法为
Figure GDA0002738290900000067
步骤6.3按照6.1和6.2的方法依次计算UPLi(i=0,1,2…k)和HPLi,最后联动目标的保护水平为
HPL=max(HPLi)
UPL=max(UPLi)
本发明具有以下的创新点:1、传统的高精度相对定位技术中,一般多关注相对定位的精度,即使有对观测值故障进行检测和排除,也多基于可靠性层面的方法,未量化导航系统的完好性风险,也未计算完好性风险要求下的保护水平。本方法考虑来自导航系统所有潜在完好性风险,根据完好性风险指标计算高精度相对定位的保护水平,实现了真正意义上的完好性监测。2、本方法对BDS/MEMS组合导航的联动目标进行自主完好性监测,无需在联动目标附近布设基站,不受监测区域的影响,作业自由灵活;可在开阔环境下和复杂环境下作业,可为无人机蜂群、地面车辆编队、舰船编队作业提供安全保障。3、本方法基于多故障假设理论,算法严密,量化了所有来自导航系统的导航风险,考虑了BDS/MEMS多传感器同时发生故障带来的风险,不仅适用于BDS/MEMS组合导航,同样也适用于其它多种不同类传感器组合导航的自主完好性监测。
附图说明
下面将结合附图及实施例对本发明做进一步说明,附图中:
图1为本发明用于BDS/MEMS组合导航下的联动编队完好性监测方法中的整体工作流程;
图2为本发明完好性风险和连续性风险的分配方案示意图;
图3为本发明确定被监测故障假设的工作流程;
图4为故障检测、剔除、保护水平计算和可用性判定之间的关系和流程;
图5为保护水平计算的工作流程;
图6为用于BDS/MEMS组合导航下的联动编队完好性监测系统结构示意图。
具体实施方式
为了使本发明的目的、技术方案及优点更加清楚明白,以下结合附图及实施例,对本发明进行进一步详细说明。应当理解,此处所描述的具体实施例仅用以解释本发明,并不用于限定本发明。
本发明为多传感器组合导航下的联动目标编队提供了一种完好性监测方法,本发明针对高精度相对定位实施完好性监测,其算法严密,并且无需布设监测基准站,作业灵活自由,可为联动目标提供可信的和稳定的完好性监测。图1显示了基于BDS/MEMS组合导航下的联动目标编队完好性监测方法的整体工作流程,图2显示了完好性风险和连续风险的分配方案示意图,图3显示了在自主完好性监测中,确定被监测的故障假设的工作流程,图4显示了故障检测、剔除、保护水平计算和可用性判定之间的关系和流程,图5显示了保护水平计算的工作流程。
为了使本发明的方法和工作流程更加清晰明确,下面结果附图对本发明进行详细说明。
图1为用于BDS/MEMS组合导航下的联动编队完好性监测方法的整体工作流程。该发明包括以下步骤:
步骤101:根据图2所示的分配方案将完好性风险指标和连续性风险在导航系统和非导航系统间分配,被监测故障状态的完好性风险上限值PHMI_M,然后将分配于导航系统的完好性风险PHMI_NAV在东、北、天(E、N和U)方向上分配。
步骤102:根据BDS/MEMS紧组合解算的联动目标间的相对定位结果,重建基线观测方程。
步骤103:根据重建的基线观测方程、先验故障概率和被监测故障的完好性风险上限值确定被监测的故障假设状态,具体确定方法见图3。
步骤104:计算各故障假设状态计分离解
Figure GDA0002738290900000081
和分离解差异
Figure GDA0002738290900000082
以及它们各自的方差。
步骤105:根据连续性风险对基线观测值进行故障检测,若检测到故障,对各故障假设状态进行故障识别,并排除识别出的故障。故障检测和识别计算流程和相互之间的关系见图4所示。
步骤106:根据分配的完好性风险,利用图5所示的流程计算高程方向和水平方向的保护水平。
步骤107:根据计算出的保护水平和安全距离限值判断联动目标相对定位结果是否满足完好性要求。步骤105、步骤106和步骤107之间的关系和工作流程见图4。
图2为完好性风险指标和连续性风险指标的分配方案。导致联动目标导航误导和导航中断的风险不仅来自于导航系统服务,还来自于导航设备和通讯设备故障等,所以首先将风险在导航系统和非导航系统间分配,然后将分配于导航系统的风险再进一步在不被监测的故障假设状态和被监测故障状态间分配。图2中的具体步骤如下:
步骤201:将完好性风险指标分配于设备和通讯异常带来的误导风险PHMI_facility和导航定位服务自身带来的误导风险PHMI_NAV
步骤202:将分配于导航定位服务风险PHMI_NAV分配为不被监测的故障假设状态导致的风险PHMI_UnM和被监测的故障假设状态导致的风险PHMI_M
步骤203:将完好性风险PHMI_M分在基线E、N和U方向上分配,分别为PHMI_E、PHMI_N和PHMI_U
步骤204:将连续性风险PCONT分配于设备和通讯异常导致的导航中断和导航系统服务故障导致的导航中断,在两者之间分配的连续性风险分别为PCONT_facilit和PFA
图3为确定被监测故障假设的工作流程,具体步骤和说明如下:
步骤301:综合考虑BDS空间信号故障、两动点的信号在传播过程中被干扰、基线解算中整周模糊的固定错误等因素造成的故障,确定联动目标基线观测值的先验故障概率PBDSi;MEMS观测值故障概率取经验值PMEMS
步骤302:建立基线观测值无故障假设H0,任意一条基线观测值故障假设状态和任意两个观测值故障假设状态等Hi(1,2…),确定相应的故障假设中健康观测值集合idxi
步骤303:根据BDS/MEMS的先验故障概率确定P(Hi)。
步骤304:将故障概率P(Hi)从大到小排序,并累加故障状态概率。
步骤305:当累加的故障假设状态概率大于PHMI_M即停止累加,被累加的故障状态即为需要被监测的故障假设状态。
步骤306:输出被监测故障假设状态,输出的故障假设状态用于下一步的保护水平计算。
图4为故障故障检测、剔除、保护水平计算与可用性判定之间的关系和流程图,具体步骤和说明如下:
步骤401:根据联动目标的基线解算结果构成假设检验量,并根据连续性风险计算故障检测限值
Figure GDA0002738290900000101
步骤402:判断是否有故障:若假设检验量小于检测限值
Figure GDA0002738290900000102
接受无故障H0的假设;
步骤403:若假设检验大于检测限值
Figure GDA0002738290900000103
对各故障假设Hi(1,2…)构成假设检验量
Figure GDA0002738290900000104
搜索若小于检测限值的故障假设状态;
步骤404:对故障进行识别:满足步骤403并且观测值最多的故障假设状态即为被识别的故,即
Figure GDA0002738290900000105
步骤405:计算排除故障后的高程和平面方向的保护水平;
步骤406:若步骤403中没有搜索到小于检测限值的故障假设状态,将高程和水平方向的保护水平均标记为“999”;
步骤407:判断联动目标相对定位结果是否满足完好性要求:若高程和平面方向的保护水平同时满足各自的告警限值,联动目标相对定位结果可用;否则不可用。
图5为高程和平面方向保护水平的计算流程示意图,具体步骤如下:
步骤5.1:计算各个故障假设状态下的分离解
Figure GDA0002738290900000111
和分离解差异
Figure GDA0002738290900000112
以及它们的方差
Figure GDA0002738290900000113
Figure GDA0002738290900000114
步骤5.2:根据5.1计算的方差和分配于E、N和U方向的完好性风险计算保护水平,高程方向的保护水平的计算如下:
Figure GDA0002738290900000115
其中
Figure GDA0002738290900000116
Figure GDA0002738290900000117
Figure GDA0002738290900000118
Figure GDA0002738290900000119
中与U方向对应的元素;E、N方向的保护水平与高程方向的保护水平计算类同;
步骤5.3:计算各个故障假设状态下的水平方向保护水平,计算方法如下
Figure GDA00027382909000001110
步骤504:确定联动目标相对定位保护水平,水平方向的保护水平为
HPL=max(HPLi)(i=0,1,2…k);
高程方向的保护水平为
UPL=max(UPLi)(i=0,1,2…k)。
为了实现上述用于BDS/MEMS组合导航下的联动编队完好性监测方法,如图6所示,本发明实施例用于BDS/MEMS组合导航下的联动编队完好性监测系统包括:
风险指标分配模块,用于将连续性风险和完好性风险指标在导航系统和非导航系统间分配,非导航系统风险指由导航和通讯硬件设备故障、信号被干扰和通讯中断带来的风险;
完好性监测模型构建模块,用于利用基于BDS/MEMS组合导航的联动目标相对定位解算结果构建用于完好性监测的数学模型;
故障状态确定模块,用于根据多故障假设,考虑所有可能存在的导航风险,构建联动目标相对定位多故障假设Hi(k=0,1,2…);根据先验完好性信息,确定需要被完好性监测的故障状态;
分离解计算模块,用于基于多故障假设计算联动目标相对定位的分离解
Figure GDA0002738290900000121
和分离解差异
Figure GDA0002738290900000122
以及它们的方差
Figure GDA0002738290900000123
Figure GDA0002738290900000124
故障检测排除模块,用于根据连续性风险对BDS/MEMS相对定位观测值进行故障检测和排除;
保护水平计算模块,用于根据完好性风险计算联动目标相对定位在平面和高程方向的保护水平;
告警模块,用于将平面和高程方向的保护水平与安全限值比较,判断保护水平是否能够满足安全限值要求,并向用户发出安全或告警的指令。
各个模块的具体实现详见上文实施例的用于BDS/MEMS组合导航下的联动编队完好性监测方法,在此不赘述。
本发明实施例计算机存储介质,其内存储有可被处理器执行的计算机程序,该计算机程序执行上述实施例的用于BDS/MEMS组合导航下的联动编队完好性监测方法,具体方法步骤在此不赘述。
应当理解的是,对本领域普通技术人员来说,可以根据上述说明加以改进或变换,而所有这些改进和变换都应属于本发明所附权利要求的保护范围。

Claims (8)

1.一种用于BDS/MEMS组合导航下的联动编队完好性监测方法,其特征在于,包括以下步骤:
步骤1,将连续性风险PCONT在导航系统和非导航系统间分配,分别为PFA和PCONT_facility;将完好性风险在导航系统和非导航系统间分配,分别为PHMI_NAV和PHMI_facility;将分配于导航系统的完好性风险PHMI_NAV在被监测的故障状态和不被监测的故障假设状态间分配,分别为PHMI_M和PHMI_UnM;将完好性风险PHMI_NAV在联动目标相对定位结果的东E、北N和天U方向上分配,分别为PHMI_E、PHMI_N和PHMI_U;非导航系统风险指由导航和通讯硬件设备故障、信号被干扰和通讯中断带来的风险;
步骤2,利用基于BDS/MEMS组合导航的联动目标相对定位解算结果构建用于完好性监测的数学模型;
步骤3,根据多故障假设,考虑所有可能存在的导航风险,构建联动目标相对定位多故障假设;根据先验完好性信息,确定需要被完好性监测的故障状态;
步骤4,基于多故障假设计算联动目标相对定位的分离解
Figure RE-FDA0003791535080000011
和分离解差异
Figure RE-FDA0003791535080000012
以及它们的方差
Figure RE-FDA0003791535080000013
Figure RE-FDA0003791535080000014
步骤5,根据连续性风险对BDS/MEMS相对定位观测值进行故障检测和排除;
步骤6,根据完好性风险计算联动目标相对定位在平面和高程方向的保护水平;
步骤7,将平面和高程方向的保护水平与安全限值比较,判断保护水平是否能够满足安全限值要求,并向用户发出安全或告警的指令。
2.根据权利要求1所述的一种用于BDS/MEMS组合导航下的联动编队完好性监测方法,其特征在于,所述的步骤2中,建立完好性监测数学模型的具体方法如下:
步骤2.1,利用BDS/MEMS组合导航联动目标相对定位结果重建观测方程
Figure RE-FDA0003791535080000021
其中
Figure RE-FDA0003791535080000022
U为将两动点MEMS传感器获得的历元间基线向量的变化信息;
Figure RE-FDA0003791535080000023
为上个历元联动目标相对定位结果;Lt是将解算模糊度固定解或浮点解恢复后得到的BDS相位双差观测值;
步骤2.2,确定观测方程的先验随机模型,其中MEMS基线观测值
Figure RE-FDA0003791535080000024
的方差
Figure RE-FDA0003791535080000025
通过以下方法得到
Figure RE-FDA0003791535080000026
上式中
Figure RE-FDA0003791535080000027
Figure RE-FDA0003791535080000028
的方差;DU为U的方差;Lt的方差
Figure RE-FDA0003791535080000029
由以下方法得到
Figure RE-FDA00037915350800000210
上式中
Figure RE-FDA00037915350800000211
为BDS相位双差观测值的方差;
Figure RE-FDA00037915350800000212
为模糊度浮点解的方差,若当模糊度固定时
Figure RE-FDA00037915350800000213
为零;
步骤2.3,综合考虑BDS空间信号故障、两动点的信号在传播过程中被干扰、基线解算中整周模糊的固定错误因素造成的故障,确定联动目标基线观测值的先验故障概率Pi;MEMS工作相对稳定,不受环境影响,MEMS的经验故障概率PMEMS取经验值。
3.根据权利要求2所述的一种用于BDS/MEMS组合导航下的联动编队完好性监测方法,其特征在于,所述的步骤3中,确定需要被完好性监测故障状态的具体方法如下:
步骤3.1,建立联动目标相对定位多故障假设Hi,i=0,1,2…k,故障假设包括无故障假设状态H0,任意一个基线观测值故障假设状态和任意两个观测值故障假设状态,确定相应的故障假设中健康观测值集合idxi
步骤3.2,根据BDS/MEMS先验故障概率确定P(Hi),P(Hi)的计算方法如下:
无故障假设状态H0发生的概率为
Figure RE-FDA0003791535080000031
其中n为观测值的个数,Pi为在步骤2.3中确定的观测值先验故障概率;任意一个传感器s发生故障且其它传感器无故障的假设为Hs,Hs发生的概率为
Figure RE-FDA0003791535080000032
步骤3.3;将故障状态概率P(Hi)从大到小排序,并从大概率开始累加故障假设状态概率,当
Figure RE-FDA0003791535080000033
即停止累加,被累加的Hi,i=0,1,2…k为需要被监测的故障假设状态。
4.根据权利要求1所述的一种用于BDS/MEMS组合导航下的联动编队完好性监测方法,其特征在于,所述的步骤4中,计算多故障假设下的联动目标相对定位的分离解
Figure RE-FDA0003791535080000034
和分离解差异
Figure RE-FDA0003791535080000035
的具体方法如下:
步骤4.1,计算各个故障假设状态的分离解
Figure RE-FDA0003791535080000036
计算方法如下
Figure RE-FDA0003791535080000037
其中z为BDS/MEMS联动目标基线观测值;S(i)为观测值到分离解的映射矩阵;
Figure RE-FDA0003791535080000038
的方差计算如下
Figure RE-FDA0003791535080000039
步骤4.2计算分离解差异
Figure RE-FDA00037915350800000310
计算方法如下
Figure RE-FDA00037915350800000311
Figure RE-FDA00037915350800000312
的方差计算如下
Figure RE-FDA00037915350800000313
5.根据权利要求1所述的一种用于BDS/MEMS组合导航下的联动编队完好性监测方法,其特征在于,所述的步骤5中,故障检测和排除具体操作方法如下:
步骤5.1,对故障进行检测,如果
Figure RE-FDA0003791535080000041
则接受无故障假设状态H0的假设,否则进入步骤5.2;其中
Figure RE-FDA0003791535080000042
为服从χ2分布的故障假设检验量;
Figure RE-FDA0003791535080000043
Figure RE-FDA0003791535080000044
F-1表示χ2分布的反函数;PFA为在步骤1中分配的连续性风险;n为观测值的个数;m为基线解算中的为未知参数的个数;
步骤5.2,逐一对故障假设Hi建立假设检验量
Figure RE-FDA0003791535080000045
Figure RE-FDA0003791535080000046
并且Hi中的观测值最多,Hi即为被识别的故障,这时进入步骤6;如果没有满足上述条件的Hi,表明故障无法识别,进入步骤5.3;
步骤5.3,在步骤5.2中,若故障无法被识别,这时的保护水平标记为HPL=999,VPL=999,表示系统不能满足完好性要求。
6.根据权利要求4所述的一种用于BDS/MEMS组合导航下的联动编队完好性监测方法,其特征在于,所述的步骤6中,确定平面和高程方向的保护水平的具体操作方法如下:
步骤6.1,计算每一个被监测的故障假设Hi的保护水平,如在故障假设下U方向的保护水平计算如下
Figure RE-FDA0003791535080000047
其中
Figure RE-FDA0003791535080000048
Figure RE-FDA0003791535080000051
Figure RE-FDA0003791535080000052
分别为步骤4.1和步骤4.2中的
Figure RE-FDA0003791535080000053
Figure RE-FDA0003791535080000054
在U方向的方差分量;
步骤6.2,E和N方向的保护水平EPLi和NPLi的计算与U方向的计算方法类同;平面方向的保护水平计算方法为
Figure RE-FDA0003791535080000055
步骤6.3按照6.1和6.2的方法依次计算UPLi和HPLi,最后联动目标的保护水平为
Figure RE-FDA0003791535080000056
7.一种用于BDS/MEMS组合导航下的联动编队完好性监测系统,其特征在于,该系统包括:
风险指标分配模块,用于将连续性风险和完好性风险指标在导航系统和非导航系统间分配,非导航系统风险指由导航和通讯硬件设备故障、信号被干扰和通讯中断带来的风险;
完好性监测模型构建模块,用于利用基于BDS/MEMS组合导航的联动目标相对定位解算结果构建完好性监测的数学模型;
故障状态确定模块,用于根据多故障假设,考虑所有可能存在的导航风险,构建联动目标相对定位多故障假设Hi,i=0,1,2…k;根据先验完好性信息,确定需要被完好性监测的故障状态;
分离解计算模块,用于基于多故障假设计算联动目标相对定位的分离解
Figure RE-FDA0003791535080000057
和分离解差异
Figure RE-FDA0003791535080000058
以及它们的方差
Figure RE-FDA0003791535080000059
Figure RE-FDA00037915350800000510
故障检测排除模块,用于根据连续性风险对BDS/MEMS相对定位观测值进行故障检测和排除;
保护水平计算模块,用于根据完好性风险计算联动目标相对定位在平面和高程方向的保护水平;
告警模块,用于将平面和高程方向的保护水平与安全限值比较,判断保护水平是否能够满足安全限值要求,并向用户发出安全或告警的指令。
8.一种计算机存储介质,其特征在于,其内存储有可被处理器执行的计算机程序,该计算机程序执行如权利要求1-6中任一项所述的用于BDS/MEMS组合导航下的联动编队完好性监测方法。
CN202010951297.5A 2020-09-11 2020-09-11 用于bds/mems组合导航下的联动编队完好性监测方法 Active CN112033441B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202010951297.5A CN112033441B (zh) 2020-09-11 2020-09-11 用于bds/mems组合导航下的联动编队完好性监测方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202010951297.5A CN112033441B (zh) 2020-09-11 2020-09-11 用于bds/mems组合导航下的联动编队完好性监测方法

Publications (2)

Publication Number Publication Date
CN112033441A CN112033441A (zh) 2020-12-04
CN112033441B true CN112033441B (zh) 2022-09-30

Family

ID=73588715

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202010951297.5A Active CN112033441B (zh) 2020-09-11 2020-09-11 用于bds/mems组合导航下的联动编队完好性监测方法

Country Status (1)

Country Link
CN (1) CN112033441B (zh)

Families Citing this family (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN114636431B (zh) * 2021-11-12 2024-04-30 北京航空航天大学 一种复杂环境下的智能运行系统导航完好性监测方法
CN114235007B (zh) * 2021-12-02 2023-09-29 北京航空航天大学 一种apnt服务的定位和完好性监测方法及系统
CN115235463B (zh) * 2022-08-30 2024-04-30 交信北斗(北京)信息科技有限公司 一种gnss/ins组合导航系统完好性风险需求分配方法
CN116047909B (zh) * 2023-01-13 2023-09-05 大连海事大学 面向海事平行搜寻的无人机-船协同鲁棒自适应控制方法
CN116859417B (zh) * 2023-07-07 2024-04-30 哈尔滨工程大学 用于北斗ppp-rtk/mems的完好性监测方法

Family Cites Families (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP1965219A1 (en) * 2007-03-01 2008-09-03 Selex Communications S.P.A. Method and system for predicting the performance of satellite navigation systems
GB0901685D0 (en) * 2009-01-31 2009-03-11 Qinetiq Ltd Navigation system integrity
CN104483678B (zh) * 2014-12-04 2017-03-01 北京航空航天大学 一种空地协同的多星座卫星导航完好性多级监测方法
CN105954768B (zh) * 2016-04-25 2018-03-30 北京航空航天大学 基于araim风险分配优化的ads‑b可用性预测方法和装置
CN108088470A (zh) * 2018-01-30 2018-05-29 北京大学 一种组合导航慢变斜坡故障完好性监测方法
CN110260885B (zh) * 2019-04-15 2020-06-30 南京航空航天大学 一种卫星/惯性/视觉组合导航系统完好性评估方法
CN111538041B (zh) * 2020-03-21 2023-09-29 哈尔滨工程大学 一种基于动对动平台电离层梯度完好性监测方法

Also Published As

Publication number Publication date
CN112033441A (zh) 2020-12-04

Similar Documents

Publication Publication Date Title
CN112033441B (zh) 用于bds/mems组合导航下的联动编队完好性监测方法
CN111860589B (zh) 一种多传感器多目标协同探测信息融合方法、系统
CN105866812B (zh) 一种车辆组合定位算法
CN101281248B (zh) 一种应用于组合卫星导航系统的多故障识别方法
CN110749319A (zh) 一种路线偏移检测的方法、装置和电子设备
Velaga et al. Map-aided integrity monitoring of a land vehicle navigation system
Sharath et al. A dynamic two-dimensional (D2D) weight-based map-matching algorithm
CN101395443B (zh) 混合定位方法和设备
CN102928858B (zh) 基于改进扩展卡尔曼滤波的gnss单点动态定位方法
CN104729506A (zh) 一种视觉信息辅助的无人机自主导航定位方法
CN102819027A (zh) 基于载波相位的卫星导航完好性监测装置及应用的方法
CN104849728B (zh) 地基增强系统的完好性评估方法
CN112230247B (zh) 一种用于城市复杂环境下gnss完好性监测方法
CN101866009B (zh) 一种适用于卫导系统缺星情况下的完好性监测方法
CN108061572B (zh) 一种海洋核动力平台综合态势显控系统及方法
CN106525081B (zh) 用于卫星导航着陆系统的便携式检测标定装置及方法
CN114545454A (zh) 一种面向自动驾驶的融合导航系统完好性监测方法
CN105738925A (zh) 一种列车定位专用的卫星接收机自主完好性方法
CN103884339A (zh) 配置运载工具导航参数值的设备
CN109085619A (zh) 多模gnss系统的定位方法及装置、存储介质、接收机
CN110988949A (zh) 定位方法、定位装置、计算机可读存储介质与可移动设备
CN103810382A (zh) 机载分布式多传感器两级数据融合策略选择方法
CN113063425A (zh) 车辆定位方法、装置、电子设备及存储介质
RU133285U1 (ru) Судовой интегрированный навигационно-промысловый комплекс
CN104965209A (zh) 一种实际导航性能的计算方法、设备及系统

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant