一种残膜回收机防缠绕挑膜装置的制 一种秧草收获机用电力驱动行走机构

一种组合导航数据的完好性检测方法及系统与流程

2022-12-13 22:13:27 来源:中国专利 TAG:


1.本技术涉及导航定位技术领域,具体而言,涉及一种组合导航数据的完好性检测方法及系统。


背景技术:

2.目前,在新能源汽车的自动驾驶领域,导航定位成为极其重要的一种功能。定位的偏差可能会造成车毁人亡。所以导航定位无论是性能的角度还是可靠性的角度,都应该纳入功能安全的体系中。
3.现有技术中,很多参与导航定位的传感器很难满足功能安全要求;即使有部分传感器达到功能安全要求,但是在和其他要素协作和融合时,会引入不安全因数,使系统整体处在一个不安全的状态,导致定位结果不准确,可靠性和稳定性均不高。


技术实现要素:

4.本技术实施例的目的在于提供一种组合导航数据的完好性检测方法、系统、电子设备及计算机可读存储介质,可以实现提高组合导航的可靠性和稳定性的技术效果。
5.第一方面,本技术实施例提供了一种组合导航数据的完好性检测方法,包括;
6.获取原始导航数据;
7.对所述原始导航数据进行原始数据完好性检测,生成第一严重度数据;
8.根据预设组合导航算法对所述原始导航数据进行处理,获得定位结果;
9.对所述预设组合导航算法的运行状态进行过程完好性检测,生成第二严重度数据;
10.根据所述定位结果进行结果完好性检测,生成第三严重度数据;
11.根据所述第一严重度数据、所述第二严重度数据、所述第三严重度数据获得完好性检测信息;
12.根据所述完好性检测信息生成所述定位结果的置信度。
13.在上述实现过程中,该组合导航数据的完好性检测方法引入了原始数据完好性、过程完好性和结果完好性的三级完好性检测体系,同时引入检测评估体系,即每次完好性检测后都会产生一个严重度指标,即第一严重度数据、第二严重度数据、第三严重度数据,每个严重度指标可表示代表对应数据的置信度,最终获得的完好性检测信息可衡量定位结果的准确性和可靠性;原始数据完好性检测可以对原始导航数据检测,从源头上保证数据的可用性,进而提高组合导航算法的稳健性,过程完好性检测进一步保证组合导航算法的稳健,一些来自算法建模本身的缺陷也能覆盖;从而,该方法可以实现提高组合导航的可靠性和稳定性的技术效果。
14.进一步地,所述根据所述第一严重度数据、所述第二严重度数据、所述第三严重度数据获得完好性检测信息的步骤,包括:
15.将所述第一严重度数据、所述第二严重度数据、所述第三严重度数据累计相加,获
得综合严重度数据;
16.将所述综合严重度数据与第一预设值、第二预设值进行比较,若所述综合严重度数据小于等于所述第一预设值,则生成低风险完好性检测信息;若所述综合严重度数据大于所述第一预设值且小于等于所述第二预设值,则生成中风险完好性检测信息;若所述综合严重度数据大于所述第二预设值,则生成高风险完好性检测信息。
17.在上述实现过程中,完好性检测信息包括低风险完好性检测信息、中风险完好性检测信息和高风险完好性检测信息,风险等级由低到高;风险等级越高,数据风险越高,表明定位结果越不准确。
18.进一步地,所述原始导航数据包括imu信息、gnss信息、车辆数据中的一种或多种,所述对所述原始导航数据进行原始数据完好性检测,生成第一严重度数据的步骤,包括:
19.对所述原始导航数据中的一种或多种进行数据完好性检测,生成数据完好性检测结果;
20.根据所述数据完好性检测结果生成所述第一严重度数据。
21.进一步地,所述对所述原始导航数据中的一种或多种进行数据完好性检测,生成数据完好性检测结果的步骤,包括:
22.对所述原始导航数据中的一种或多种进行序列检测、校验码检测、长度检测、超时检测、取值范围检测、数值跳变检测中的一种或多种检测,生成所述数据完好性检测结果。
23.进一步地,所述原始导航数据包括imu信息,所述对所述原始导航数据进行原始数据完好性检测,生成第一严重度数据的步骤,包括:
24.根据预设噪声模型对所述imu信息进行噪声模型完好性检测,生成噪声模型完好性检测数据;
25.根据所述噪声模型完好性检测数据生成所述第一严重度数据。
26.进一步地,所述原始导航数据包括imu信息、gnss信息、车辆数据中的至少两种,所述对所述原始导航数据进行原始数据完好性检测,生成第一严重度数据的步骤,包括:
27.对所述原始导航数据中的至少两种进行一致性检测,生成一致性检测数据;
28.根据所述一致性检测数据生成所述第一严重度数据。
29.进一步地,所述imu信息包括主imu信息和冗余imu信息,所述对所述原始导航数据中的至少两种进行一致性检测,生成一致性检测数据的步骤,包括:
30.对所述主imu信息和冗余imu信息之间进行一致性检测,生成所述一致性检测数据。
31.进一步地,所述imu信息包括主imu信息和冗余imu信息,所述对所述原始导航数据中的至少两种进行一致性检测,生成一致性检测数据的步骤,包括:
32.对所述gnss信息、所述主imu信息、所述冗余imu信息中的两者/三者之间进行一致性检测,生成所述一致性检测数据。
33.进一步地,所述imu信息包括主imu信息和冗余imu信息,所述对所述原始导航数据中的至少两种进行一致性检测,生成一致性检测数据的步骤,包括:
34.对所述gnss信息、所述主imu信息、所述冗余imu信息、所述车辆数据中的两者/三者/四者之间进行一致性检测,生成所述一致性检测数据。
35.进一步地,所述对所述gnss信息、所述主imu信息、所述冗余imu信息、所述车辆数
据中的两者/三者/四者之间进行一致性检测,生成所述一致性检测数据的步骤,包括:
36.进行所述主imu信息、所述冗余imu信息的一致性检测,若两者一致性符合要求,继续和所述gnss信息进行一致性检测;若两者一致性不符合要求,根据所述主imu信息、所述冗余imu信息两者生成所述一致性检测数据;
37.判断所述主imu信息、所述冗余imu信息、所述gnss信息三者的一致性是否符合要求,若是则继续和所述车辆数据进行一致性检测,并根据所述gnss信息、所述主imu信息、所述冗余imu信息、所述车辆数据四者生成所述一致性检测数据;若否,根据所述gnss信息、所述主imu信息、所述冗余imu信息三者生成所述一致性检测数据。
38.进一步地,所述一致性检测采用最小二乘残差法,所述对所述原始导航数据中的至少两种进行一致性检测,生成一致性检测数据的步骤,包括:
39.对所述原始导航数据中的至少两种进行最小二乘残差法处理,生成所述一致性检测数据。
40.进一步地,所述原始导航数据包括imu信息、gnss信息、车辆数据中的至少两种,所述对所述原始导航数据进行原始数据完好性检测,生成第一严重度数据的步骤,包括:
41.对所述原始导航数据中的一种或多种进行数据完好性检测,生成数据完好性检测结果;
42.根据预设噪声模型对所述imu信息进行噪声模型完好性检测,生成噪声模型完好性检测数据;
43.对所述原始导航数据中的至少两种进行一致性检测,生成一致性检测数据;
44.根据所述数据完好性检测结果、所述噪声模型完好性检测数据、所述一致性检测数据中的一种或多种生成所述第一严重度数据。
45.进一步地,所述对所述预设组合导航算法的运行状态进行过程完好性检测,生成第二严重度数据的步骤,包括:
46.对所述预设组合导航算法的运行状态进行观测新息检验,生成观测新息检验结果;
47.根据所述观测新息检验结果生成所述第二严重度数据。
48.进一步地,所述对所述预设组合导航算法的运行状态进行过程完好性检测,生成第二严重度数据的步骤,包括:
49.对所述预设组合导航算法的运行状态进行方差矩阵分析,生成方差矩阵分析结果;
50.根据所述方差矩阵分析结果生成所述第二严重度数据。
51.进一步地,所述对所述预设组合导航算法的运行状态进行过程完好性检测,生成第二严重度数据的步骤,包括:
52.对所述预设组合导航算法的运行状态进行状态向量残差检验,生成状态向量残差检验结果;
53.根据所述状态向量残差检验结果生成所述第二严重度数据。
54.进一步地,所述对所述预设组合导航算法的运行状态进行过程完好性检测,生成第二严重度数据的步骤,包括:
55.对所述预设组合导航算法的运行状态进行观测新息检验,生成观测新息检验结
果;
56.对所述预设组合导航算法的运行状态进行方差矩阵分析,生成方差矩阵分析结果;
57.对所述预设组合导航算法的运行状态进行状态向量残差检验,生成状态向量残差检验结果;
58.根据所述观测新息检验结果、所述方差矩阵分析结果、所述状态向量残差检验结果中的一种或多种生成所述第二严重度数据。
59.在上述实现过程中,过程完好性检测组合导航算法内的运行情况,过程完好性的分析方法包括状态向量残差检验、方差矩阵分析、观测新息检验三个方面。
60.进一步地,所述结果完好性采用并行参数完好性检测,所述根据所述定位结果进行结果完好性检测,生成第三严重度数据的步骤,包括:
61.获取冗余导航数据;
62.根据所述冗余导航数据获得冗余定位结果;
63.将所述冗余定位结果和所述定位结果进行一致性检验,生成所述第三严重度数据。
64.在上述实现过程中,冗余导航数据为组合导航系统中的冗余导航单元(冗余imu等)通过其他方法获得的参数,由冗余导航数据获得冗余定位结果,冗余定位结果和定位结果可以形成对照,第三严重度数据反映定位结果的准确性。
65.进一步地,所述冗余导航数据为冗余imu的数据,所述根据所述冗余导航数据获得冗余定位结果的步骤,包括:
66.通过预设捷联解算算法对所述冗余imu的数据进行处理,生成所述冗余定位结果。
67.进一步地,所述将所述冗余定位结果和所述定位结果进行一致性检验,生成所述第三严重度数据的步骤,包括:
68.对所述冗余定位结果和所述定位结果的对应参数进行一致性检验,生成所述第三严重度数据,所述对应参数包括位置参数、速度参数、姿态参数、零偏参数中的一种或多种。
69.在上述实现过程中,置信度可以直接反映出定位结果的准确性,置信度越高,定位结果的准确性越高。
70.第二方面,本技术实施例提供了一种组合导航数据的完好性检测系统,包括:
71.原始数据获取模块,用于获取原始导航数据;
72.第一严重度模块,用于对所述原始导航数据进行原始数据完好性检测,生成第一严重度数据;
73.组合导航定位模块,用于根据预设组合导航算法对所述原始导航数据进行处理,获得定位结果;
74.第二严重度模块,用于对所述预设组合导航算法的运行状态进行过程完好性检测,生成第二严重度数据;
75.第三严重度模块,用于根据所述定位结果进行结果完好性检测,生成第三严重度数据;
76.完好性检测模块,用于根据所述第一严重度数据、所述第二严重度数据、所述第三严重度数据获得完好性检测信息;
77.置信度模块,用于根据所述完好性检测信息生成所述定位结果的置信度。
78.进一步地,所述完好性检测模块包括:
79.综合严重度单元,用于将所述第一严重度数据、所述第二严重度数据、所述第三严重度数据累计相加,获得综合严重度数据;
80.完好性检测单元,用于将所述综合严重度数据与第一预设值、第二预设值进行比较,若所述综合严重度数据小于等于所述第一预设值,则生成低风险完好性检测信息;若所述综合严重度数据大于所述第一预设值且小于等于所述第二预设值,则生成中风险完好性检测信息;若所述综合严重度数据大于所述第二预设值,则生成高风险完好性检测信息。
81.进一步地,所述原始导航数据包括imu信息、gnss信息、车辆数据中的一种或多种,所述第一严重度模块包括:
82.数据完好性检测单元,用于对所述原始导航数据中的一种或多种进行数据完好性检测,生成数据完好性检测结果;
83.第一严重度单元,用于根据所述数据完好性检测结果生成所述第一严重度数据。
84.进一步地,所述数据完好性检测单元具体用于对所述原始导航数据中的一种或多种进行序列检测、校验码检测、长度检测、超时检测、取值范围检测、数值跳变检测中的一种或多种检测,生成所述数据完好性检测结果。
85.进一步地,所述原始导航数据包括imu信息,所述第一严重度模块包括:
86.噪声模型完好性检测单元,用于根据预设噪声模型对所述imu信息进行噪声模型完好性检测,生成噪声模型完好性检测数据;
87.第一严重度单元,用于根据所述噪声模型完好性检测数据生成所述第一严重度数据。
88.进一步地,所述原始导航数据包括imu信息、gnss信息、车辆数据中的至少两种,所述第一严重度模块包括:
89.一致性检测单元,用于对所述原始导航数据中的至少两种进行一致性检测,生成一致性检测数据;
90.第一严重度单元,用于根据所述一致性检测数据生成所述第一严重度数据。
91.进一步地,所述imu信息包括主imu信息和冗余imu信息,所述一致性检测单元具体用于对所述主imu信息和冗余imu信息之间进行一致性检测,生成所述一致性检测数据。
92.进一步地,所述imu信息包括主imu信息和冗余imu信息,所述一致性检测单元具体用于对所述gnss信息、所述主imu信息、所述冗余imu信息中的两者/三者之间进行一致性检测,生成所述一致性检测数据。
93.进一步地,所述imu信息包括主imu信息和冗余imu信息,所述一致性检测单元具体用于对所述gnss信息、所述主imu信息、所述冗余imu信息、所述车辆数据中的两者/三者/四者之间进行一致性检测,生成所述一致性检测数据。
94.进一步地,所述一致性检测单元具体用于进行所述主imu信息、所述冗余imu信息的一致性检测,若两者一致性符合要求,继续和所述gnss信息进行一致性检测;若两者一致性不符合要求,根据所述主imu信息、所述冗余imu信息两者生成所述一致性检测数据;
95.判断所述主imu信息、所述冗余imu信息、所述gnss信息三者的一致性是否符合要求,若是则继续和所述车辆数据进行一致性检测,并根据所述gnss信息、所述主imu信息、所
述冗余imu信息、所述车辆数据四者生成所述一致性检测数据;若否,根据所述gnss信息、所述主imu信息、所述冗余imu信息三者生成所述一致性检测数据。
96.进一步地,所述一致性检测采用最小二乘残差法,所述一致性检测单元具体用于对所述原始导航数据中的至少两种进行最小二乘残差法处理,生成所述一致性检测数据。
97.进一步地,所述原始导航数据包括imu信息、gnss信息、车辆数据中的至少两种,所述第一严重度模块包括:
98.数据完好性检测单元,用于对所述原始导航数据中的一种或多种进行数据完好性检测,生成数据完好性检测结果;
99.噪声模型完好性检测单元,用于根据预设噪声模型对所述imu信息进行噪声模型完好性检测,生成噪声模型完好性检测数据;
100.一致性检测单元,用于对所述原始导航数据中的至少两种进行一致性检测,生成一致性检测数据;
101.第一严重度单元,用于根据所述数据完好性检测结果、所述噪声模型完好性检测数据、所述一致性检测数据中的一种或多种生成所述第一严重度数据。
102.进一步地,所述第二严重度模块包括:
103.观测新息检验单元,用于对所述预设组合导航算法的运行状态进行观测新息检验,生成观测新息检验结果;
104.第二严重度单元,用于根据所述观测新息检验结果生成所述第二严重度数据。
105.进一步地,所述第二严重度模块包括:
106.方差矩阵分析单元,用于对所述预设组合导航算法的运行状态进行方差矩阵分析,生成方差矩阵分析结果;
107.第二严重度单元,用于根据所述方差矩阵分析结果生成所述第二严重度数据。
108.进一步地,所述第二严重度模块包括:
109.状态向量残差检验单元,用于对所述预设组合导航算法的运行状态进行状态向量残差检验,生成状态向量残差检验结果;
110.第二严重度单元,用于根据所述状态向量残差检验结果生成所述第二严重度数据。
111.进一步地,所述第二严重度模块包括:
112.观测新息检验单元,用于对所述预设组合导航算法的运行状态进行观测新息检验,生成观测新息检验结果;
113.方差矩阵分析单元,用于对所述预设组合导航算法的运行状态进行方差矩阵分析,生成方差矩阵分析结果;
114.状态向量残差检验单元,用于对所述预设组合导航算法的运行状态进行状态向量残差检验,生成状态向量残差检验结果;
115.第二严重度单元,用于根据所述观测新息检验结果、所述方差矩阵分析结果、状态向量残差检验结果中的一种或多种生成所述第二严重度数据。
116.进一步地,所述第三严重度模块包括:
117.冗余数据获取单元,用于获取冗余导航数据;
118.冗余定位结果单元,用于根据所述冗余导航数据获得冗余定位结果;
119.第三严重度单元,用于将所述冗余定位结果和所述定位结果进行一致性检验,生成所述第三严重度数据。
120.进一步地,所述冗余定位结果单元具体用于通过预设捷联解算算法对所述冗余imu的数据进行处理,生成所述冗余定位结果。
121.进一步地,所述第三严重度单元具体用于对所述冗余定位结果和所述定位结果的对应参数进行一致性检验,生成所述第三严重度数据,所述对应参数包括位置参数、速度参数、姿态参数、零偏参数中的一种或多种。
122.第三方面,本技术实施例提供的一种电子设备,包括:存储器、处理器以及存储在所述存储器中并可在所述处理器上运行的计算机程序,所述处理器执行所述计算机程序时实现如第一方面任一项所述的方法的步骤。
123.第四方面,本技术实施例提供的一种计算机可读存储介质,所述计算机可读存储介质上存储有指令,当所述指令在计算机上运行时,使得所述计算机执行如第一方面任一项所述的方法。
124.第五方面,本技术实施例提供的一种计算机程序产品,所述计算机程序产品在计算机上运行时,使得计算机执行如第一方面任一项所述的方法。
125.本技术公开的其他特征和优点将在随后的说明书中阐述,或者,部分特征和优点可以从说明书推知或毫无疑义地确定,或者通过实施本技术公开的上述技术即可得知。
126.为使本技术的上述目的、特征和优点能更明显易懂,下文特举较佳实施例,并配合所附附图,作详细说明如下。
附图说明
127.为了更清楚地说明本技术实施例的技术方案,下面将对本技术实施例中所需要使用的附图作简单地介绍,应当理解,以下附图仅示出了本技术的某些实施例,因此不应被看作是对范围的限定,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他相关的附图。
128.图1为本技术实施例提供的组合导航系统的结构示意图;
129.图2为本技术实施例提供的一种组合导航数据的完好性检测方法的流程示意图;
130.图3为本技术实施例提供的获得完好性检测信息的流程示意图;
131.图4为本技术实施例提供的生成第一严重度数据的流程示意图;
132.图5为本技术实施例提供的原始数据完好性检测的流程示意图;
133.图6为本技术实施例提供的生成第二严重度数据的流程示意图;
134.图7为本技术实施例提供的过程完好性检测的流程示意图;
135.图8为本技术实施例提供的生成第三严重度数据的流程示意图;
136.图9为本技术实施例提供的结果完好性检测的流程示意图;
137.图10为本技术实施例提供的组合导航数据的完好性检测系统的结构框图;
138.图11为本技术实施例提供的另一种组合导航数据的完好性检测方法的流程示意图;
139.图12为本技术实施例提供的另一种组合导航数据的完好性检测方法的流程示意图;
140.图13为本技术实施例提供的另一种组合导航数据的完好性检测方法的流程示意图;
141.图14为本技术实施例提供的另一种组合导航数据的完好性检测方法的流程示意图;
142.图15为本技术实施例提供的另一种组合导航数据的完好性检测方法的流程示意图;
143.图16为本技术实施例提供的另一种组合导航数据的完好性检测方法的流程示意图;
144.图17为本技术实施例提供的一种电子设备的结构框图。
具体实施方式
145.下面将结合本技术实施例中的附图,对本技术实施例中的技术方案进行描述。
146.应注意到:相似的标号和字母在下面的附图中表示类似项,因此,一旦某一项在一个附图中被定义,则在随后的附图中不需要对其进行进一步定义和解释。同时,在本技术的描述中,术语“第一”、“第二”等仅用于区分描述,而不能理解为指示或暗示相对重要性。
147.本技术实施例提供了一种组合导航数据的完好性检测方法、系统、电子设备及计算机可读存储介质,该组合导航数据的完好性检测方法引入了原始数据完好性、过程完好性和结果完好性的三级完好性检测体系,同时引入检测评估体系,即每次完好性检测后都会产生一个严重度指标,即第一严重度数据、第二严重度数据、第三严重度数据,每个严重度指标可表示代表对应数据的置信度,最终获得的完好性检测信息可衡量定位结果的准确性和可靠性;原始数据完好性检测可以对原始导航数据检测,从源头上保证数据的可用性,进而提高组合导航算法的稳健性,过程完好性检测进一步保证组合导航算法的稳健,一些来自算法建模本身的缺陷也能覆盖;从而,该方法可以实现提高组合导航的可靠性和稳定性的技术效果。
148.示例性地,组合导航是指综合各种导航设备,由监视器和计算机进行控制的导航系统。大多数组合导航系统以惯导系统为主,其原因主要是由于惯性导航能够提供比较多的导航参数,还能够提供全姿态信息参数,这是其他导航系统所不能比拟的。在本技术实施例中,组合导航指利用imu信息、gnss信息和车辆数据等导航参数进行导航的方法。
149.示例性地,惯性测量单元(imu,inertial measurement unit)是主要用来检测和测量加速度与旋转运动的传感器;全球导航卫星系统(gnss,global navigation satellite system)是利用一组卫星的伪距、星历、卫星发射时间等观测量,同时还必须知道用户钟差。
150.实施例一:
151.请参见图1,图1为本技术实施例提供的组合导航系统的结构示意图。
152.示例性地,基本的组合导航系统包括三部分:数据采集,采集的数据包括imu信息、gnss信息和车辆数据等;组合导航算法;定位结果输出。本技术实施例提供的组合导航数据的完好性检测方法在此基础上引入了原始数据完好性、过程完好性和结果完好性的三级完好性检测体系。
153.请参见图2,图2为本技术实施例提供的一种组合导航数据的完好性检测方法的流
程示意图,该组合导航数据的完好性检测方法包括如下步骤;
154.s100:获取原始导航数据。
155.示例性地,原始导航数据包括imu采集的imu信息和定位芯片接收的gnss信息。当应用于车辆导航时,所述原始导航数据还可以包括车辆数据。
156.可选地,imu信息包括加速度、角速度等,gnss信息包括定位坐标等,车辆数据包括轮速、方向盘等信息;需要注意的是,imu信息、gnss信息、车辆数据包括的具体类型可根据需要进行取舍,此处不作限定。
157.s200:对原始导航数据进行原始数据完好性检测,生成第一严重度数据。
158.示例性地,原始数据完好性检测就是从s100获得的原始导航数据进行分析,第一严重度数据可衡量原始导航数据的质量好坏。
159.s300:根据预设组合导航算法对原始导航数据进行处理,获得定位结果。
160.s400:对预设组合导航算法的运行状态进行过程完好性检测,生成第二严重度数据。
161.示例性地,在组合导航算法的运行过程中进行过程完好性检测,可以检测组合导航算法内部的运行情况,第二严重度数据可衡量组合导航算法是否正常运行。
162.s500:根据定位结果进行结果完好性检测,生成第三严重度数据。
163.示例性地,结果完好性可以对定位结果进行检验,若校验失败,则表明存在故障,定位结果失真;第三严重度数据可衡量定位结果的失真情况。
164.s600:根据第一严重度数据、第二严重度数据、第三严重度数据获得完好性检测信息;
165.s700:根据完好性检测信息生成定位结果的置信度。
166.示例性地,置信度可以直接反映出定位结果的准确性,置信度越高,定位结果的准确性越高。
167.示例性地,该组合导航数据的完好性检测方法引入了原始数据完好性、过程完好性和结果完好性的三级完好性检测体系,同时引入检测评估体系,即每次完好性检测后都会产生一个严重度指标,即第一严重度数据、第二严重度数据、第三严重度数据,每个严重度指标可表示代表对应数据的置信度,最终获得的完好性检测信息可衡量定位结果的准确性和可靠性;原始数据完好性检测可以对原始导航数据检测,从源头上保证数据的可用性,进而提高组合导航算法的稳健性,过程完好性检测进一步保证组合导航算法的稳健,一些来自算法建模本身的缺陷也能覆盖;从而,该方法可以实现提高组合导航的可靠性和稳定性的技术效果。
168.请参见图3,图3为本技术实施例提供的获得完好性检测信息的流程示意图。
169.示例性地,s600:根据第一严重度数据、第二严重度数据、第三严重度数据获得完好性检测信息的步骤,包括:
170.s610:将第一严重度数据、第二严重度数据、第三严重度数据累计相加,获得综合严重度数据;
171.s620:将综合严重度数据与第一预设值、第二预设值进行比较,若综合严重度数据小于等于第一预设值,则生成低风险完好性检测信息;若综合严重度数据大于第一预设值且小于等于第二预设值,则生成中风险完好性检测信息;若综合严重度数据大于第二预设
值,则生成高风险完好性检测信息。
172.示例性地,完好性检测信息包括低风险完好性检测信息、中风险完好性检测信息和高风险完好性检测信息,风险等级由低到高;风险等级越高,数据风险越高,表明定位结果越不准确。
173.在一些实施场景中,假设第一预设值为3,第二预设值为6;综合严重度数据为e,则:
174.e≤3,定位结果的数据可用,使用该定位结果的风险较低;
175.3《e≤6,不确定,故障未确认,使用定位结果可能有风险;
176.6《e,不可用,故障已确认,使用定位结果的风险较高。
177.可选地,本技术实施例还提供了部分严重度数据,该部分严重度数据可以是第一严重度数据或第一严重度数据 第二严重度数据;类似地,部分严重度数据与综合严重度数据的使用方法相同,此处不再赘述。
178.请参见图4,图4为本技术实施例提供的生成第一严重度数据的流程示意图。
179.示例性地,原始导航数据包括imu信息和gnss信息,在应用于车辆导航时,所述原始导航数据还可以包括车辆数据,s200:对原始导航数据进行原始数据完好性检测,生成第一严重度数据的步骤,包括:
180.s210:对原始导航数据中的一种或多种进行数据完好性检测,生成数据完好性检测结果;
181.s220:根据预设噪声模型对imu信息进行噪声模型完好性检测,生成噪声模型完好性检测数据;
182.s230:对原始导航数据中的至少两种进行一致性检测,生成一致性检测数据;
183.s240:根据数据完好性检测结果、噪声模型完好性检测数据、一致性检测数据中的一种或多种生成第一严重度数据。
184.在一些实施方式中,首先进行数据完好性检测,若检测不通过,则可以根据数据完好性检测结果生成第一严重度数据,而无需再进行s220和s230的步骤。若数据完好性检测通过,则继续对imu信息进行噪声模型检测,若检测不通过,则可以根据噪声模型完好性检测数据生成第一严重度数据,而无需再进行s230步骤。若噪声模型检测通过,则继续对原始导航数据中的至少两种进行一致性检测,生成一致性检测数据,并根据该一致性检测数据生成第一严重度数据。
185.在一些实施方式中,所述对原始导航数据中的至少两种进行一致性检测,包括:对imu信息和gnss信息进行一致性检测,若通过,则再对imu信息、gnss和车辆数据三者之间进行一致性检测,根据三者的一致性检测数据输出第一严重度数据。任何一个环节检测不通过,就可以输出第一严重度数据(此时输出的第一严重度数据e》6),之后可以继续或不继续进行后续步骤的一致性检测。
186.示例性地,s210:对原始导航数据中的一种或多种进行数据完好性检测,生成数据完好性检测结果的步骤,包括:
187.对原始导航数据中的一种或多种进行序列检测、校验码检测、长度检测、超时检测、取值范围检测、数值跳变检测中的一种或多种检测,生成数据完好性检测结果。
188.示例性地,序列检测、校验码检测、长度检测、超时检测、取值范围检测、数值跳变
检测可以按照预设的顺序依次进行,此处不做限定。
189.示例性地,一致性检测采用最小二乘残差法,s230:对原始导航数据进行一致性检测,生成一致性检测数据的步骤,包括:
190.对原始导航数据进行最小二乘残差法处理,生成一致性检测数据。
191.示例性地,imu信息包括主imu信息和冗余imu信息,s230:对原始导航数据中的至少两种进行一致性检测,生成一致性检测数据的步骤,包括:
192.对主imu信息和冗余imu信息之间进行一致性检测,生成一致性检测数据。
193.可选地,s230:对原始导航数据中的至少两种进行一致性检测,生成一致性检测数据的步骤,包括:
194.对gnss信息、主imu信息、冗余imu信息中的两者/三者之间进行一致性检测,生成一致性检测数据。
195.可选地,s230:对原始导航数据中的至少两种进行一致性检测,生成一致性检测数据的步骤,包括:
196.对gnss信息、主imu信息、冗余imu信息、车辆数据中的两者/三者/四者之间进行一致性检测,生成一致性检测数据。
197.在一些实施方式中,首先进行主imu信息、冗余imu信息的一致性检测,若两者一致性符合要求,继续和gnss信息进行一致性检测;若两者一致性不符合要求,根据主imu信息、冗余imu信息两者生成一致性检测数据;
198.然后,判断主imu信息、冗余imu信息、gnss信息三者的一致性是否符合要求,若是则继续和车辆数据进行一致性检测,并根据gnss信息、主imu信息、冗余imu信息、车辆数据四者生成一致性检测数据;若否,根据gnss信息、主imu信息、冗余imu信息三者生成一致性检测数据。
199.请参见图5,图5为本技术实施例提供的原始数据完好性检测的流程示意图。
200.示例性地,组合导航系统中包括至少两个imu,其中至少一个作为主imu,至少一个作为冗余imu。
201.示例性地,数据完好性指所有的原始数据经过数据完好性检测,即进行数据层面的分析,数据完好性分析方法包括如下的一种或多种:
202.1)序列检测,数据必须是顺序发送,防止丢失或错乱;若通过序列检测发现数据不是顺序发送的,则数据完好性差,表示数据完好性检测不通过,此时会生成较高严重度,即生成较高的第一严重度数据。
203.2)校验码检测,防止数据被删改或干扰;若通过校验码检测发现数据的校验码错误,则数据完好性差,表示数据完好性检测不通过,此时会生成较高严重度,即生成较高的第一严重度数据。
204.3)长度检测,数据长度必须正确;若通过长度检测发现数据的长度不再预设范围内,则数据完好性差,表示数据完好性检测不通过,此时会生成较高严重度,即生成较高的第一严重度数据。
205.4)超时检测,确保数据是最新数据,有时效性;若通过超时检测发现数据的发送时间超过阈值,则数据完好性差,表示数据完好性检测不通过,此时会生成较高严重度,即生成较高的第一严重度数据。
206.5)取值范围检测,数据必须在合理范围内;若通过取值范围检测发现数据偏差较大,则数据完好性差,表示数据完好性检测不通过,此时会生成较高严重度,即生成较高的第一严重度数据。
207.6)数值跳变检测,防止异常数据出现;若通过数值跳变检测发现数据出现跳变(相邻数值突然增大或减小),则数据完好性差,表示数据完好性检测不通过,此时会生成较高严重度,即生成较高的第一严重度数据。
208.示例性地,噪声模型完好性即根据噪声模型进行检测,噪声模型参数包括零偏、零偏稳定性、allan方差;可选地,噪声模型参数可以通过经验值进行设定,超过预设范围就要提升严重度,即生成较高的第一严重度数据。
209.请参见图6,图6为本技术实施例提供的生成第二严重度数据的流程示意图。
210.示例性地,s400:对预设组合导航算法的运行状态进行过程完好性检测,生成第二严重度数据的步骤,包括:
211.s410:对预设组合导航算法的运行状态进行观测新息检验,生成观测新息检验结果;
212.s420:对预设组合导航算法的运行状态进行方差矩阵分析,生成方差矩阵分析结果数据;
213.s430:对预设组合导航算法的运行状态进行状态向量残差检验,生成状态向量残差检验结果;
214.s440:根据所述观测新息检验结果、方差矩阵分析结果、状态向量残差检验结果中的一种或多种生成第二严重度数据。
215.在一些实施方式中,步骤s410至步骤s430是按顺序进行的,首先进行步骤s410,若步骤s410中的观测新息检测通过,则继续步骤s420进行方差矩阵分析,若步骤s420中的方差矩阵分析通过,则继续步骤s430进行状态向量残差检测。若其中一个检测、分析或检验不通过,则可以根据之前的检测或分析结果生成第二严重度数据,而不需要再继续进行之后步骤。
216.在一些实施方式中,s400:对预设组合导航算法的运行状态进行过程完好性检测,生成第二严重度数据的步骤,包括:
217.对预设组合导航算法的运行状态进行观测新息检验,生成观测新息检验结果;
218.根据观测新息检验结果生成第二严重度数据。
219.在一些实施方式中,s400:对预设组合导航算法的运行状态进行过程完好性检测,生成第二严重度数据的步骤,包括:
220.对预设组合导航算法的运行状态进行方差矩阵分析,生成方差矩阵分析结果;
221.根据方差矩阵分析结果生成第二严重度数据。
222.在一些实施方式中,s400:对预设组合导航算法的运行状态进行过程完好性检测,生成第二严重度数据的步骤,包括:
223.对预设组合导航算法的运行状态进行状态向量残差检验,生成状态向量残差检验结果;
224.根据状态向量残差检验结果生成第二严重度数据。
225.在一些实施例中,还可以将根据观测新息检验结果生成第二严重度数据、根据方
差矩阵分析结果生成第二严重度数据、根据状态向量残差检验结果生成第二严重度数据中的两者或三者进行相加或按权重相加后生成最终的第二严重度数据。
226.请参见图7,图7为本技术实施例提供的过程完好性检测的流程示意图。
227.示例性地,过程完好性检测组合导航算法内的运行情况,如图7所示,过程完好性的分析方法包括:状态向量残差检验、方差矩阵分析、观测新息检验。
228.示例性地,在观测新息检验中,观测新息是实际观测向量与观测更新之前、由状态估计并计算得来的观测向量之间的差值。对观测新息进行峰值检测、合理性检验,可以检查出大异常。其次进行标准差检查,可以检查出短时间内小异常。以上的一项或多项检查不通过的,认为可能出现风险,提升严重度,即生成较高的第二严重度数据。
229.示例性地,在方差矩阵分析中,在长时间运行之后,噪声的不断注入或者建模不当,导致误差协方差失真;方差矩阵分析的主要方法是误差协方差矩阵分析。例如,现有n行n列的方差矩阵p,比较矩阵p的对角线各元素pii与事先限定的值[pmax,pmin],若pii》pmax或pii《pmin,表示方差矩阵分析不通过,则提升严重度,即生成较高的第二严重度数据,并将第i行和i列的所有元素乘以预设值λii,其中λii与pii、pmax和pmin有关。
[0230]
示例性地,在状态向量残差检验中,状态向量残差是真实状态向量与其卡尔曼滤波估计之间的差值。该残差在预设范围内认为算法稳定,超出则认为状态向量残差检验不通过,可能出现风险,要提升严重度,即生成较高的第二严重度数据。
[0231]
本实施例中,可以根据观测信息检验结果、方差矩阵分析结果和状态向量残差检验结果中的一种或多种生成第二严重度数据。在一种实施方式中,首先对预设组合导航算法的运行状态进行观测新息检验,生成观测新息检验结果,根据观测新息检验结果生成第二严重度数据,若该第二严重度数据超出预设阈值范围,表明组合导航算法的运行状态不稳定,此时可以不再进行方差矩阵分析和状态向量残差检验,若该第二严重度数据未超出预设阈值范围,表明组合导航算法的运行状态稳定,此时继续进行方差矩阵分析,再根据方差矩阵分析结果生成第二严重度数据,若该第二严重度数据超出预设阈值范围,则表明组合导航算法的运行状态不稳定,此时可以不再进行状态向量残差检验,若该第二严重度数据未超出预设阈值范围,表明组合导航算法的运行状态稳定,此时继续进行状态向量残差检验,根据状态向量残差检验结果生成第二严重度数据。
[0232]
请参见图8,图8为本技术实施例提供的生成第三严重度数据的流程示意图。
[0233]
示例性地,结果完好性采用并行参数完好性检测,s500:根据定位结果进行结果完好性检测,生成第三严重度数据的步骤,包括:
[0234]
s510:获取冗余导航数据;
[0235]
s520:将冗余定位结果和定位结果进行一致性检验,生成第三严重度数据;
[0236]
s530:根据冗余导航数据获得冗余定位结果。
[0237]
示例性地,冗余导航数据为组合导航系统中的冗余导航单元(冗余imu等)通过其他方法获得的参数,由冗余导航数据获得冗余定位结果,冗余定位结果和定位结果可以形成对照,第三严重度数据反映定位结果的准确性。
[0238]
在一些实施方式中,冗余定位结果和定位结果比较时可以采用两个数值作差的检验方法,当差值超过误差允许范围,则认为检验失败,定位结果不准确,此时将生成较高的第三严重度数据。
[0239]
示例性地,冗余导航数据为冗余imu的数据,s520:根据冗余导航数据获得冗余定位结果的步骤,包括:
[0240]
通过预设捷联解算算法对冗余imu的数据进行处理,生成冗余定位结果。
[0241]
示例性地,s530:将冗余定位结果和定位结果进行一致性检验,生成第三严重度数据的步骤,包括:
[0242]
对冗余定位结果和定位结果的对应参数进行一致性检验,生成第三严重度数据,对应参数包括位置参数、速度参数、姿态参数、零偏参数中的一种或多种。
[0243]
请参见图9,图9为本技术实施例提供的结果完好性检测的流程示意图。
[0244]
示例性地,结果完好性采用并行参数完好性检测方案,即每个冗余导航数据的参数都与组合导航算法的参数进行比较;如果检验失败,则表明存在故障,由此确定第三严重度数据。
[0245]
示例性地,冗余导航数据的参数都与组合导航算法的参数一一对应;导航参数使用陀螺、加速度计、位置、速度、姿态、零偏等。
[0246]
请参见图10,图10为本技术实施例提供的组合导航数据的完好性检测系统的结构框图,该组合导航数据的完好性检测系统包括:
[0247]
原始数据获取模块100,用于获取原始导航数据;
[0248]
第一严重度模块200,用于对原始导航数据进行原始数据完好性检测,生成第一严重度数据;
[0249]
组合导航定位模块300,用于根据预设组合导航算法对原始导航数据进行处理,获得定位结果;
[0250]
第二严重度模块400,用于对预设组合导航算法的运行状态进行过程完好性检测,生成第二严重度数据;
[0251]
第三严重度模块500,用于根据定位结果进行结果完好性检测,生成第三严重度数据;
[0252]
完好性检测模块600,用于根据第一严重度数据、第二严重度数据、第三严重度数据获得完好性检测信息;
[0253]
置信度模块700,用于根据完好性检测信息生成定位结果的置信度。
[0254]
示例性地,完好性检测模块600包括:
[0255]
综合严重度单元,用于将第一严重度数据、第二严重度数据、第三严重度数据累计相加,获得综合严重度数据;
[0256]
完好性检测单元,用于将综合严重度数据与第一预设值、第二预设值进行比较,若综合严重度数据小于等于第一预设值,则生成低风险完好性检测信息;若综合严重度数据大于第一预设值且小于等于第二预设值,则生成中风险完好性检测信息;若综合严重度数据大于第二预设值,则生成高风险完好性检测信息。
[0257]
示例性地,原始导航数据包括imu信息、gnss信息、车辆数据中的一种或多种,第一严重度模块200包括:
[0258]
数据完好性检测单元,用于对原始导航数据中的一种或多种进行数据完好性检测,生成数据完好性检测结果;
[0259]
第一严重度单元,用于根据数据完好性检测结果生成第一严重度数据。
[0260]
示例性地,数据完好性检测单元具体用于对原始导航数据中的一种或多种进行序列检测、校验码检测、长度检测、超时检测、取值范围检测、数值跳变检测中的一种或多种检测,生成数据完好性检测结果。
[0261]
示例性地,原始导航数据包括imu信息,第一严重度模块210包括:
[0262]
噪声模型完好性检测单元,用于根据预设噪声模型对imu信息进行噪声模型完好性检测,生成噪声模型完好性检测数据;
[0263]
第一严重度单元,用于根据噪声模型完好性检测数据生成第一严重度数据。
[0264]
示例性地,原始导航数据包括imu信息、gnss信息、车辆数据中的至少两种,第一严重度模块200包括:
[0265]
一致性检测单元,用于对原始导航数据中的至少两种进行一致性检测,生成一致性检测数据;
[0266]
第一严重度单元,用于根据一致性检测数据生成第一严重度数据。
[0267]
示例性地,一致性检测单元具体用于对原始导航数据中的至少两种进行最小二乘残差法处理,生成一致性检测数据。
[0268]
示例性地,imu信息包括主imu信息和冗余imu信息,一致性检测单元具体用于对主imu信息和冗余imu信息之间进行一致性检测,生成一致性检测数据。
[0269]
示例性地,imu信息包括主imu信息和冗余imu信息,一致性检测单元具体用于对gnss信息、主imu信息、冗余imu信息中的两者/三者之间进行一致性检测,生成一致性检测数据。
[0270]
示例性地,imu信息包括主imu信息和冗余imu信息,一致性检测单元具体用于对gnss信息、主imu信息、冗余imu信息、车辆数据中的两者/三者/四者之间进行一致性检测,生成一致性检测数据。
[0271]
示例性地,一致性检测单元具体用于进行主imu信息、冗余imu信息的一致性检测,若两者一致性符合要求,继续和gnss信息进行一致性检测;若两者一致性不符合要求,根据主imu信息、冗余imu信息两者生成一致性检测数据;判断主imu信息、冗余imu信息、gnss信息三者的一致性是否符合要求,若是则继续和车辆数据进行一致性检测,并根据gnss信息、主imu信息、冗余imu信息、车辆数据四者生成一致性检测数据;若否,根据gnss信息、主imu信息、冗余imu信息三者生成一致性检测数据。
[0272]
进一步地,原始导航数据包括imu信息、gnss信息、车辆数据中的至少两种,第一严重度模块200包括:
[0273]
数据完好性检测单元,用于对原始导航数据中的一种或多种进行数据完好性检测,生成数据完好性检测结果;
[0274]
噪声模型完好性检测单元,用于根据预设噪声模型对imu信息进行噪声模型完好性检测,生成噪声模型完好性检测数据;
[0275]
一致性检测单元,用于对原始导航数据中的至少两种进行一致性检测,生成一致性检测数据;
[0276]
第一严重度单元,用于根据数据完好性检测结果、噪声模型完好性检测数据、一致性检测数据中的一种或多种生成第一严重度数据。
[0277]
进一步地,第二严重度模块400包括:
[0278]
观测新息检验单元,用于对预设组合导航算法的运行状态进行观测新息检验,生成观测新息检验结果;
[0279]
第二严重度单元,用于根据观测新息检验结果生成第二严重度数据。
[0280]
进一步地,第二严重度模块400包括:
[0281]
方差矩阵分析单元,用于对预设组合导航算法的运行状态进行方差矩阵分析,生成方差矩阵分析结果;
[0282]
第二严重度单元,用于根据方差矩阵分析结果生成第二严重度数据。
[0283]
进一步地,第二严重度模块400包括:
[0284]
状态向量残差检验单元,用于对预设组合导航算法的运行状态进行状态向量残差检验,生成状态向量残差检验结果;
[0285]
第二严重度单元,用于根据状态向量残差检验结果生成第二严重度数据。
[0286]
示例性地,第二严重度模块400包括:
[0287]
观测新息检验单元,用于对预设组合导航算法的运行状态进行观测新息检验,生成观测新息检验结果;
[0288]
方差矩阵分析单元,用于对预设组合导航算法的运行状态进行方差矩阵分析,生成方差矩阵分析结果;
[0289]
状态向量残差检验单元,用于对预设组合导航算法的运行状态进行状态向量残差检验,生成状态向量残差检验结果;
[0290]
第二严重度单元,用于根据所述观测新息检验结果、方差矩阵分析结果、状态向量残差检验结果中的一种或多种生成第二严重度数据。
[0291]
示例性地,第三严重度模块500包括:
[0292]
冗余数据获取单元,用于获取冗余导航数据;
[0293]
冗余定位结果单元,用于根据冗余导航数据获得冗余定位结果;
[0294]
第三严重度单元,用于将冗余定位结果和定位结果进行一致性检验,生成第三严重度数据。
[0295]
示例性地,冗余定位结果单元具体用于通过预设捷联解算算法对冗余imu的数据进行处理,生成冗余定位结果。
[0296]
示例性地,第三严重度单元具体用于对冗余定位结果和定位结果的对应参数进行一致性检验,生成第三严重度数据,对应参数包括位置参数、速度参数、姿态参数、零偏参数中的一种或多种。
[0297]
实施例二:
[0298]
本技术实施例还提供了一种组合导航数据的完好性检测方法;请参见图11,该方法包括如下步骤:
[0299]
s101:获取原始导航数据。
[0300]
原始导航数据包括imu信息和gnss信息,在应用于车辆导航时,所示原始导航数据还可以包括车辆数据。
[0301]
s102:对原始导航数据进行原始数据完好性检测,生成第一严重度数据。
[0302]
示例性地,原始数据完好性检测就是从s101获得的原始导航数据进行分析,第一严重度数据可衡量原始导航数据的质量好坏。
[0303]
s103:根据预设组合导航算法对原始导航数据进行处理,获得定位结果。
[0304]
s104:根据第一严重度数据获得完好性检测信息;
[0305]
s105:根据完好性检测信息生成定位结果的置信度。
[0306]
示例性地,原始导航数据包括imu采集的imu信息和定位芯片接收的gnss信息。当应用于车辆导航时,所述原始导航数据还可以包括车辆数据。
[0307]
示例性地,图11为本技术实施例提供的使用原始数据完好性检测进行完好性检测的方法,原始数据完好性检测可以对原始导航数据检测,从源头上保证数据的可用性,进而提高组合导航算法的稳健性;关于原始数据完好性检测的具体实施细节请参见实施例一的相关部分,此处不再赘述。
[0308]
实施例三:
[0309]
本技术实施例还提供了一种组合导航数据的完好性检测方法;请参见图12,该方法包括如下步骤:
[0310]
s201:获取原始导航数据。
[0311]
示例性地,原始导航数据包括imu采集的imu信息、定位芯片接收的gnss信息以及车辆数据等。
[0312]
s202:根据预设组合导航算法对原始导航数据进行处理,获得定位结果。
[0313]
s203:对预设组合导航算法的运行状态进行过程完好性检测,生成第二严重度数据。
[0314]
示例性地,在组合导航算法的运行过程中进行过程完好性检测,可以检测组合导航算法内部的运行情况,第二严重度数据可衡量组合导航算法是否正常运行。
[0315]
s204:根据第二严重度数据获得完好性检测信息;
[0316]
s205:根据完好性检测信息生成定位结果的置信度。
[0317]
示例性地,原始导航数据包括imu采集的imu信息和定位芯片接收的gnss信息。当应用于车辆导航时,所述原始导航数据还可以包括车辆数据。
[0318]
示例性地,图12为本技术实施例提供的使用过程完好性检测进行完好性检测的方法,过程完好性检测可保证组合导航算法的稳健性,一些来自算法建模本身的缺陷也能覆盖;关于过程完好性检测的具体实施细节请参见实施例一的相关部分,此处不再赘述。
[0319]
实施例四:
[0320]
本技术实施例还提供了一种组合导航数据的完好性检测方法;请参见图13,该方法包括如下步骤:
[0321]
s301:获取原始导航数据。
[0322]
示例性地,原始导航数据包括imu采集的imu信息、定位芯片接收的gnss信息以及车辆数据等。
[0323]
s302:根据预设组合导航算法对原始导航数据进行处理,获得定位结果。
[0324]
s303:根据定位结果进行结果完好性检测,生成第三严重度数据。
[0325]
示例性地,结果完好性可以对定位结果进行检验,若校验失败,则表明存在故障,定位结果失真;第三严重度数据可衡量定位结果的失真情况。
[0326]
s304:根据第三严重度数据获得完好性检测信息;
[0327]
s305:根据完好性检测信息生成定位结果的置信度。
[0328]
示例性地,原始导航数据包括imu采集的imu信息和定位芯片接收的gnss信息。当应用于车辆导航时,所述原始导航数据还可以包括车辆数据。
[0329]
示例性地,图13为本技术实施例提供的使用结果完好性检测进行完好性检测的方法,结果完好性检测可保证定位结果的准确性;关于结果完好性检测的具体实施细节请参见实施例一的相关部分,此处不再赘述。
[0330]
实施例五:
[0331]
本技术实施例还提供了一种组合导航数据的完好性检测方法;请参见图14,该方法包括如下步骤:
[0332]
s401:获取原始导航数据。
[0333]
示例性地,原始导航数据包括imu采集的imu信息、定位芯片接收的gnss信息以及车辆数据等。
[0334]
s402:对原始导航数据进行原始数据完好性检测,生成第一严重度数据。
[0335]
示例性地,原始数据完好性检测就是从s101获得的原始导航数据进行分析,第一严重度数据可衡量原始导航数据的质量好坏。
[0336]
s403:根据预设组合导航算法对原始导航数据进行处理,获得定位结果。
[0337]
s404:对预设组合导航算法的运行状态进行过程完好性检测,生成第二严重度数据。
[0338]
示例性地,在组合导航算法的运行过程中进行过程完好性检测,可以检测组合导航算法内部的运行情况,第二严重度数据可衡量组合导航算法是否正常运行。
[0339]
s405:根据第一严重度数据和第二严重度数据获得完好性检测信息;
[0340]
s406:根据完好性检测信息生成定位结果的置信度。
[0341]
示例性地,原始导航数据包括imu采集的imu信息和定位芯片接收的gnss信息。当应用于车辆导航时,所述原始导航数据还可以包括车辆数据。
[0342]
示例性地,图14为本技术实施例提供的使用原始数据完好性检测和过程完好性检测进行完好性检测的方法,原始数据完好性检测可以对原始导航数据检测,从源头上保证数据的可用性,进而提高组合导航算法的稳健性,过程完好性检测进一步保证组合导航算法的稳健,一些来自算法建模本身的缺陷也能覆盖;关于原始数据完好性检测、过程完好性检测的具体实施细节请参见实施例一的相关部分,此处不再赘述。
[0343]
实施例六:
[0344]
本技术实施例还提供了一种组合导航数据的完好性检测方法;请参见图15,该方法包括如下步骤:
[0345]
s501:获取原始导航数据。
[0346]
示例性地,原始导航数据包括imu采集的imu信息、定位芯片接收的gnss信息以及车辆数据等。
[0347]
s502:对原始导航数据进行原始数据完好性检测,生成第一严重度数据。
[0348]
示例性地,原始数据完好性检测就是从s101获得的原始导航数据进行分析,第一严重度数据可衡量原始导航数据的质量好坏。
[0349]
s503:根据预设组合导航算法对原始导航数据进行处理,获得定位结果。
[0350]
s504:根据定位结果进行结果完好性检测,生成第三严重度数据。
[0351]
示例性地,结果完好性可以对定位结果进行检验,若校验失败,则表明存在故障,定位结果失真;第三严重度数据可衡量定位结果的失真情况。
[0352]
s505:根据第一严重度数据和第三严重度数据获得完好性检测信息;
[0353]
s506:根据完好性检测信息生成定位结果的置信度。
[0354]
示例性地,原始导航数据包括imu采集的imu信息和定位芯片接收的gnss信息。当应用于车辆导航时,所述原始导航数据还可以包括车辆数据。
[0355]
示例性地,图15为本技术实施例提供的使用原始数据完好性检测和结果完好性检测进行完好性检测的方法,原始数据完好性检测可以对原始导航数据检测,从源头上保证数据的可用性,进而提高组合导航算法的稳健性,结果完好性检测可保证定位结果的准确性;关于原始数据完好性检测、结果完好性检测的具体实施细节请参见实施例一的相关部分,此处不再赘述。
[0356]
实施例七:
[0357]
本技术实施例还提供了一种组合导航数据的完好性检测方法;请参见图16,该方法包括如下步骤:
[0358]
s601:获取原始导航数据。
[0359]
示例性地,原始导航数据包括imu采集的imu信息、定位芯片接收的gnss信息以及车辆数据等。
[0360]
s603:根据预设组合导航算法对原始导航数据进行处理,获得定位结果。
[0361]
s603:对预设组合导航算法的运行状态进行过程完好性检测,生成第二严重度数据。
[0362]
示例性地,在组合导航算法的运行过程中进行过程完好性检测,可以检测组合导航算法内部的运行情况,第二严重度数据可衡量组合导航算法是否正常运行。
[0363]
s604:根据定位结果进行结果完好性检测,生成第三严重度数据。
[0364]
示例性地,结果完好性可以对定位结果进行检验,若校验失败,则表明存在故障,定位结果失真;第三严重度数据可衡量定位结果的失真情况。
[0365]
s605:根据第二严重度数据和第三严重度数据获得完好性检测信息;
[0366]
s606:根据完好性检测信息生成定位结果的置信度。
[0367]
示例性地,原始导航数据包括imu采集的imu信息和定位芯片接收的gnss信息。当应用于车辆导航时,所述原始导航数据还可以包括车辆数据。
[0368]
示例性地,图16为本技术实施例提供的使用过程完好性检测和结果完好性检测进行完好性检测的方法,过程完好性检测保证组合导航算法的稳健,一些来自算法建模本身的缺陷也能覆盖,结果完好性检测可保证定位结果的准确性;关于过程完好性检测、结果完好性检测的具体实施细节请参见实施例一的相关部分,此处不再赘述。
[0369]
本技术还提供一种电子设备,请参见图17,图17为本技术实施例提供的一种电子设备的结构框图。电子设备可以包括处理器510、通信接口520、存储器530和至少一个通信总线540。其中,通信总线540用于实现这些组件直接的连接通信。其中,本技术实施例中电子设备的通信接口520用于与其他节点设备进行信令或数据的通信。处理器510可以是一种集成电路芯片,具有信号的处理能力。电子设备可以执行上述图1至图9方法实施例涉及的各个步骤。
[0370]
本技术实施例还提供一种存储介质,所述存储介质上存储有指令,当所述指令在计算机上运行时,所述计算机程序被处理器执行时实现方法实施例所述的方法,为避免重复,此处不再赘述。
[0371]
本技术还提供一种计算机程序产品,所述计算机程序产品在计算机上运行时,使得计算机执行方法实施例所述的方法。
再多了解一些

本文用于创业者技术爱好者查询,仅供学习研究,如用于商业用途,请联系技术所有人。

发表评论 共有条评论
用户名: 密码:
验证码: 匿名发表

相关文献