CN110186478A - 用于捷联式惯导系统的惯性传感器选型方法及系统 - Google Patents

Abstract

本发明公开一种用于捷联式惯导系统的惯性传感器选型方法及系统。本发明根据参照运动轨迹和惯性解算轨迹确定导航误差后，判断导航误差是否小于预设的惯导系统的误差阈值。若是，根据惯性传感器误差对惯性传感器进行选型，否则，根据导航误差更新惯性传感器误差，返回重新确定导航误差直至其小于误差阈值。可见，本发明提供的用于捷联式惯导系统的惯性传感器选型方法及系统，选型过程中根据导航误差自动调整惯性传感器误差，在满足SINS导航误差阈值的前提下，能够选出精度最低的惯性传感器，即选出SINS导航误差容许范围内成本最低的惯性传感器，从而实现满足导航精度要求的前提下，尽可能的节约惯性传感器成本的目的。

Description

用于捷联式惯导系统的惯性传感器选型方法及系统

技术领域

本发明涉及惯性导航技术领域，特别是涉及一种用于捷联式惯导系统的惯性传感器选型方法及系统。

背景技术

惯性导航技术是综合了力学、数学、机电、控制、光学和计算机等学科的综合技术。惯性导航技术通过惯性传感器(陀螺仪和加速度计)来测量载体的线运动和角运动，然后通过一系列数学解算来实时解算运动载体的位置、速度和姿态信息。惯性导航系统有平台式和捷联式两种实现方式。捷联式惯导系统(SINS，Strap-down Inertial NavigationSystem)与平台式惯导系统最大的不同是省去了机电导航平台，将惯性传感器(陀螺仪和加速度计)直接安装在载体上，从而可以极大地降低系统总体重量、体积和成本。

由于SINS具有良好的短期精度，并且所受外界的制约因素少，稳定性强，目前已经得到了广泛的应用。但是SINS也有其固有的缺点与劣势，其导航定位误差随时间不断积累，并最终导致导航系统误差发散，无法实现准确导航定位。其中，SINS的两个主要误差源为：初始对准误差以及导航系统使用的惯性传感器精度。其中，导航系统使用的惯性传感器精度是对SINS的精度影响最为显著的因素，例如精度较高的陀螺仪(例如光纤陀螺仪)的零偏(零位误差)为0.1°/h，而精度较差一些的陀螺仪(例如MEMS陀螺仪)的零偏则可以达到100°/h；采用这两种不同的陀螺仪构成SINS，导航精度的差距十分显著。但是，必须要指出的是，惯性传感器的精度提高将直接导致成本显著上升，例如，前边所述的光纤陀螺仪，其造价为30万元左右，而MEMS陀螺仪的造价可能仅为数百甚至数十元，二者的成本相差十分悬殊。因此，如何在满足导航精度要求的前提下，尽可能的节约惯性传感器成本，成为本领域技术人员亟需解决的技术问题。

发明内容

本发明的目的是提供一种用于捷联式惯导系统的惯性传感器选型方法及系统，能够选出SINS导航误差容许范围内成本最低的惯性传感器，从而实现满足导航精度要求的前提下，尽可能的节约惯性传感器成本的目的。

为实现上述目的，本发明提供了如下方案：

一种用于捷联式惯导系统的惯性传感器选型方法，所述捷联式惯导系统包括载体和惯性传感器，所述惯性传感器直接安装在所述载体上，所述惯性传感器包括陀螺仪和加速度计，所述选型方法包括：

获取所述捷联式惯导系统的误差阈值、所述惯性传感器误差、所述载体的姿态角速率和轨迹加速度，所述惯性传感器误差包括陀螺仪零偏和加速度计零偏；

根据所述姿态角速率和所述轨迹加速度确定所述载体的参照运动轨迹；

根据所述姿态角速率、所述轨迹加速度和所述惯性传感器误差确定所述载体的惯性解算轨迹；

根据所述参照运动轨迹和所述惯性解算轨迹确定导航误差；

判断所述导航误差是否小于所述误差阈值，获得第一判断结果；

当所述第一判断结果表示所述导航误差大于或者等于所述误差阈值时，根据所述导航误差更新所述惯性传感器误差，返回所述“根据所述姿态角速率、所述轨迹加速度和所述惯性传感器误差确定所述载体的惯性解算轨迹”；

当所述第一判断结果表示所述导航误差小于所述误差阈值时，根据所述惯性传感器误差对惯性传感器进行选型。

可选的，所述根据所述导航误差更新所述惯性传感器误差，具体包括：

判断姿态误差是否大于或者等于姿态误差阈值，获得第二判断结果，所述导航误差包括姿态误差和位置误差，所述误差阈值包括姿态误差阈值和位置误差阈值；

当所述第二判断结果表示所述姿态误差大于或者等于所述姿态误差阈值时，根据所述姿态误差和所述姿态误差阈值更新所述陀螺仪零偏。

可选的，当所述第二判断结果表示所述姿态误差小于所述姿态误差阈值时，判断所述位置误差是否小于所述位置误差阈值，获得第三判断结果；

当所述第三判断结果表示所述位置误差小于所述位置误差阈值时，根据当前的所述陀螺仪零偏和所述加速度计零偏对惯性传感器进行选型；

当所述第三判断结果表示所述位置误差大于或者等于位置误差阈值时，根据所述位置误差和所述位置误差阈值更新所述陀螺仪零偏和所述加速度计零偏。

可选的，所述根据所述姿态误差和所述姿态误差阈值更新所述陀螺仪零偏，具体包括：

计算姿态误差差值，所述姿态误差差值为所述姿态误差的绝对值与所述姿态误差阈值的差值；

根据所述姿态误差差值更新所述陀螺仪零偏。

可选的，所述根据所述姿态误差差值更新所述陀螺仪零偏，具体包括：

根据公式：确定姿态差值因子，其中，θ^SINS表示姿态误差，表示姿态误差阈值，T_total表示导航总时长，Δ_G表示姿态差值因子；

根据公式：E′_G＝E_G-0.6Δ_G-ε，更新所述陀螺仪零偏，其中，E′_G表示根据姿态误差差值更新后的陀螺仪零偏，E_G表示更新前的陀螺仪零偏，ε表示姿态误差修正因子。

可选的，所述根据所述位置误差和所述位置误差阈值更新所述陀螺仪零偏和所述加速度计零偏，具体包括：

计算位置误差差值，所述位置误差差值为所述位置误差的绝对值与所述位置误差阈值的差值；

根据所述位置误差差值更新所述陀螺仪零偏和所述加速度计零偏。

可选的，所述根据所述位置误差差值更新所述陀螺仪零偏和所述加速度计零偏，具体包括：

根据公式：确定陀螺仪位置差值因子，其中，Δ_P表示陀螺仪位置差值因子，P^SINS表示位置误差，表示位置误差阈值，P_total表示参照运动轨迹的总路程，T_total表示导航总时长；

根据公式：E′_G′＝E′_G-0.6Δ_p-ε_p，更新所述陀螺仪零偏，其中，E′_G′表示根据位置误差差值更新后的陀螺仪零偏，ε_p表示陀螺仪位置误差修正因子；

根据公式：确定加速度计位置差值因子；

根据公式：更新加速度计零偏，其中，E_A表示更新前的加速度计零偏，E′_A表示更新后的加速度计零偏，表示加速度计位置误差修正因子。

一种用于捷联式惯导系统的惯性传感器选型系统，所述捷联式惯导系统包括载体和惯性传感器，所述惯性传感器直接安装在所述载体上，所述惯性传感器包括陀螺仪和加速度计，所述选型系统包括：

数据获取模块，用于获取所述捷联式惯导系统的误差阈值、所述惯性传感器误差、所述载体的姿态角速率和轨迹加速度，所述惯性传感器误差包括陀螺仪零偏和加速度计零偏；

真实轨迹确定模块，用于根据所述姿态角速率和所述轨迹加速度确定所述载体的参照运动轨迹；

惯性解算模块，用于根据所述姿态角速率、所述轨迹加速度和所述惯性传感器误差确定所述载体的惯性解算轨迹；

导航误差确定模块，用于根据所述参照运动轨迹和所述惯性解算轨迹确定导航误差；

判断模块，用于判断所述导航误差是否小于所述误差阈值，获得第一判断结果；

选型模块，用于当所述第一判断结果表示所述导航误差小于所述误差阈值时，根据所述惯性传感器误差对惯性传感器进行选型；

传感器误差更新模块，用于当所述第一判断结果表示所述导航误差大于或者等于所述误差阈值时，根据所述导航误差更新所述惯性传感器误差。

根据本发明提供的具体实施例，本发明公开了以下技术效果：

本发明提供的用于捷联式惯导系统的惯性传感器选型方法及系统，首先，根据姿态角速率和轨迹加速度确定载体的参照运动轨迹，并根据姿态角速率、轨迹加速度和初选的惯性传感器误差确定载体的惯性解算轨迹。然后，根据参照运动轨迹和所述惯性解算轨迹确定导航误差。在此基础上，进一步判断导航误差是否小于误差阈值。若是，根据惯性传感器误差对惯性传感器进行选型，否则，根据导航误差更新惯性传感器误差，返回继续根据姿态角速率、轨迹加速度和惯性传感器误差确定载体的惯性解算轨迹，直至导航误差小于误差阈值。可见，本发明提供的用于捷联式惯导系统的惯性传感器选型方法及系统，选型过程中根据导航误差自动调整惯性传感器误差，在满足SINS导航误差阈值的前提下，能够选出精度最低的惯性传感器，即选出SINS导航误差容许范围内成本最低的惯性传感器，从而实现满足导航精度要求的前提下，尽可能的节约惯性传感器成本的目的。

附图说明

为了更清楚地说明本发明实施例或现有技术中的技术方案，下面将对实施例中所需要使用的附图作简单地介绍，显而易见地，下面描述中的附图仅仅是本发明的一些实施例，对于本领域普通技术人员来讲，在不付出创造性劳动的前提下，还可以根据这些附图获得其它的附图。

图1为本发明实施例提供的一种用于捷联式惯导系统的惯性传感器选型方法的流程图；

图2为本发明实施例提供的更新惯性传感器误差的流程图；

图3为本发明实施例提供的一种用于捷联式惯导系统的惯性传感器选型系统的流程图；

图4为本发明实施例提供的惯性传感器选型系统的实施流程图；

图5为本发明实施例提供的生成参照运动轨迹和惯性传感器模拟输出的流程图；

图6为本发明实施例提供的惯性解算轨迹与参照运动轨迹的对比图；

图7为本发明实施例提供的惯性传感器误差更新流程图；

图8为本发明实施例提供的惯性传感器选型系统的运行界面图。

具体实施方式

下面将结合本发明实施例中的附图，对本发明实施例中的技术方案进行清楚、完整地描述，显然，所描述的实施例仅仅是本发明一部分实施例，而不是全部的实施例。基于本发明中的实施例，本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例，都属于本发明保护的范围。

本发明的目的是提供一种用于捷联式惯导系统的惯性传感器选型方法及系统，能够选出SINS导航误差容许范围内成本最低的惯性传感器，从而实现满足导航精度要求的前提下，尽可能的节约惯性传感器成本的目的。

为使本发明的上述目的、特征和优点能够更加明显易懂，下面结合附图和具体实施方式对本发明作进一步详细的说明。

图1为本发明实施例提供的一种用于捷联式惯导系统的惯性传感器选型方法的流程图。如图1所示，一种用于捷联式惯导系统的惯性传感器选型方法，所述捷联式惯导系统包括载体和惯性传感器，所述惯性传感器直接安装在所述载体上，所述惯性传感器包括陀螺仪和加速度计，所述选型方法包括：

步骤11：获取所述捷联式惯导系统的误差阈值、所述惯性传感器误差、所述载体的姿态角速率和轨迹加速度，所述惯性传感器误差包括陀螺仪零偏和加速度计零偏。实际应用中，可根据任务需求制定相应的SINS导航误差最大允许值，即SINS导航的误差阈值。同时，初设的惯性传感器误差为一个较大的初值，使得对应的导航误差大于捷联式惯导系统的误差阈值

步骤12：根据所述姿态角速率和所述轨迹加速度确定所述载体的参照运动轨迹。

步骤13：根据所述姿态角速率、所述轨迹加速度和所述惯性传感器误差确定所述载体的惯性解算轨迹。

步骤14：根据所述参照运动轨迹和所述惯性解算轨迹确定导航误差。

步骤15：判断所述导航误差是否小于所述误差阈值，获得第一判断结果。

当所述第一判断结果表示所述导航误差小于所述误差阈值时，执行步骤16。

当所述第一判断结果表示所述导航误差大于或者等于所述误差阈值时，执行步骤17后，返回步骤13。

步骤16：根据所述惯性传感器误差对惯性传感器进行选型。

步骤17：根据所述导航误差更新所述惯性传感器误差。

图2为本发明实施例提供的更新惯性传感器误差的流程图。如图2所示，步骤17：根据所述导航误差更新所述惯性传感器误差，具体包括：

步骤171：判断姿态误差是否大于或者等于姿态误差阈值，获得第二判断结果，所述导航误差包括姿态误差和位置误差，所述误差阈值包括姿态误差阈值和位置误差阈值。

当所述第二判断结果表示所述姿态误差大于或者等于所述姿态误差阈值时，执行步骤172。

当所述第二判断结果表示所述姿态误差小于所述姿态误差阈值时，执行步骤173。

步骤172：根据所述姿态误差和所述姿态误差阈值更新所述陀螺仪零偏。

步骤173：判断所述位置误差是否小于所述位置误差阈值，获得第三判断结果。

当所述第三判断结果表示所述位置误差小于所述位置误差阈值时，执行步骤174。

当所述第三判断结果表示所述位置误差大于或者等于位置误差阈值时，执行步骤175。

步骤174：根据当前的所述陀螺仪零偏和所述加速度计零偏对惯性传感器进行选型。

步骤175：根据所述位置误差和所述位置误差阈值更新所述陀螺仪零偏和所述加速度计零偏。

具体地，步骤172：根据所述姿态误差和所述姿态误差阈值更新所述陀螺仪零偏，具体包括：

计算姿态误差差值，所述姿态误差差值为所述姿态误差的绝对值与所述姿态误差阈值的差值。

根据所述姿态误差差值更新所述陀螺仪零偏，具体包括：

根据公式：确定姿态差值因子，其中，θ^SINS表示姿态误差，表示姿态误差阈值，T_total表示导航总时长，Δ_G表示姿态差值因子；

根据公式：E′_G＝E_G-0.6Δ_G-ε，更新所述陀螺仪零偏，其中，E′_G表示根据姿态误差差值更新后的陀螺仪零偏，E_G表示更新前的陀螺仪零偏，ε表示姿态误差修正因子。

具体地，步骤175：根据所述位置误差和所述位置误差阈值更新所述陀螺仪零偏和所述加速度计零偏，具体包括：

计算位置误差差值，所述位置误差差值为所述位置误差的绝对值与所述位置误差阈值的差值。

根据所述位置误差差值更新所述陀螺仪零偏和所述加速度计零偏，具体包括：

根据公式：确定陀螺仪位置差值因子，其中，Δ_P表示陀螺仪位置差值因子，P^SINS表示位置误差，表示位置误差阈值，P_total表示参照运动轨迹的总路程，T_total表示导航总时长；

根据公式：E′_G′＝E′_G-0.6Δ_p-ε_p，更新所述陀螺仪零偏，其中，E′_G′表示根据位置误差差值更新后的陀螺仪零偏，ε_p表示陀螺仪位置误差修正因子；

根据公式：确定加速度计位置差值因子；

根据公式：更新加速度计零偏，其中，E_A表示更新前的加速度计零偏，E′_A表示更新后的加速度计零偏，表示加速度计位置误差修正因子。

图3为本发明实施例提供的一种用于捷联式惯导系统的惯性传感器选型系统的流程图。如图3所示，一种用于捷联式惯导系统的惯性传感器选型系统，所述捷联式惯导系统包括载体和惯性传感器，所述惯性传感器直接安装在所述载体上，所述惯性传感器包括陀螺仪和加速度计，所述选型系统包括：

数据获取模块21，用于获取所述捷联式惯导系统的误差阈值、所述惯性传感器误差、所述载体的姿态角速率和轨迹加速度，所述惯性传感器误差包括陀螺仪零偏和加速度计零偏；

真实轨迹确定模块22，用于根据所述姿态角速率和所述轨迹加速度确定所述载体的参照运动轨迹；

惯性解算模块23，用于根据所述姿态角速率、所述轨迹加速度和所述惯性传感器误差确定所述载体的惯性解算轨迹；

导航误差确定模块24，用于根据所述参照运动轨迹和所述惯性解算轨迹确定导航误差；

判断模块25，用于判断所述导航误差是否小于所述误差阈值，获得第一判断结果；

选型模块26，用于当所述第一判断结果表示所述导航误差小于所述误差阈值时，根据所述惯性传感器误差对惯性传感器进行选型；

传感器误差更新模块27，用于当所述第一判断结果表示所述导航误差大于或者等于所述误差阈值时，根据所述导航误差更新所述惯性传感器误差。

图4为本发明实施例提供的惯性传感器选型系统的实施流程图。如图4所示，本发明提出的适用于SINS的惯性传感器选型系统，建立了一套模拟惯性传感器误差至SINS导航误差的误差传播子系统，误差传播子系统包括：数据获取模块21、真实轨迹确定模块22、惯性解算模块23和导航误差确定模块24，用来模拟SINS实际运行过程中惯性传感器误差对SINS导航误差的影响。在此基础上，设计了SINS误差反馈修正子系统，即传感器误差更新模块27，该子系统可根据SINS导航误差的结果的变化自动反馈调整惯性传感器误差。判断模块25将仿真得到的SINS导航误差与误差阈值进行比较，如果比较结果满足要求，则输出当前的惯性传感器精度，用于对惯性传感器进行选型。否则，传感器误差更新模块27进行差异性惯性传感器误差调整后，重新计算导航误差，最终使得SINS导航误差满足预设的精度要求，获得SINS导航误差容许范围内最经济的惯性传感器，从而实现惯性传感器的最优选型，辅助相关设计人员完成惯性传感器选型任务。

本发明的实施过程如下：

(1)根据实际的任务需求，制定相应的SINS导航误差最大允许值，即SINS导航误差阈值。考虑SINS的实际情况，一般需考虑以下两类误差限：姿态误差阈值与位置误差阈值。

(2)根据实际的任务情况，规划安装SINS的载体的运动轨迹、姿态角速率和轨迹加速度。由于载体的运行特性对SINS误差传播具有一定的影响，为了确保参照运动轨迹足够贴近真实运行情况，参照运动轨迹应该与载体实际运行情况充分吻合，能够充分表征载体实际运行情况的运行轨迹。

(3)根据所述姿态角速率、所述轨迹加速度和所述惯性传感器误差确定导航误差。

图5为本发明实施例提供的生成参照运动轨迹和惯性传感器模拟输出的流程图。如图5所示，将本发明中用到的坐标系定义如下：

惯性坐标系(简称i系)，地球坐标系(简称e系)，地理坐标系(简称g系)，导航坐标系(简称n系)，载体坐标系(简称b系，本发明中定义为右前上)，轨迹坐标系(简称t系)，本发明选取东-北-天(ENU)地理坐标系作为导航坐标系(即g系与n系为同一坐标系)。

由上述定义可知，载体坐标系与地理坐标系之间的转换关系用余弦矩阵表示为：

轨迹坐标系到导航坐标系与之间的转换关系由余弦矩阵表达为：

其中，θ为俯仰角，其定义域为(-90°，90°)；为航向角，其定义域为(-180°，180°)；γ为横滚角，其定义域为(0°，360°)。

设M为地球表面上一点，M的经纬度分别为λ和L，则M点处的地球坐标系到地理坐标系/导航坐标系的关系用余弦矩阵表示为：

基于上述坐标系定义，可以进行参照运动轨迹计算和惯性解算轨迹计算。整个载体轨迹微分方程组以姿态角变化率(姿态角速率)ω(t)和载体的轨迹加速度a_t(t)为输入，参照运动轨迹和惯性解算轨迹作为方程组输出。

首先介绍如何计算载体的参照运动轨迹，具体计算流程如下：在SINS中，载体坐标系相对地理坐标系的转动角速率在载体坐标系下的投影为具体形式为：

其中，姿态角微分方程为通过上式得到从而可以得到姿态矩阵微分方程为:

其中，代表的反对称矩阵，其具体形式为：

设定姿态矩阵的初值，结合态矩阵微分方程可以实时计算的值，进一步可以计算得到姿态角，首先对进行如下定义：

可解算出姿态角：

根据微分方程得速度微分方程为：

其中:

gⁿ＝[0 0 -g]^T,R_M＝R_e(1-2e+3esin²L),

式中，f^b代表载体坐标系下加速度计输出，g₀＝9.78049m/s²为赤道平面上的重力加速度，R_e＝6378137m为地球椭球模型的半长轴，e＝1/298.257为地球椭球模型的椭圆度，ω_ie为地球自转角速率，V_n＝[V_N V_E V_U]^T,V_N,V_E,V_U分别为载体在东北天三轴上的速度，L为当前载体的纬度，h为当前载体的高度，和为和的反对称矩阵，其具体定义为：

根据载体相对地球的运动速度计算可得载体位置微分方程为：

通过上述计算可以得到表征载体真实状态的参照运动轨迹对应的姿态速度(V_N,V_E,V_U)，位置(L,λ,h)信息。

下面计算根据惯性传感器输出确定的惯性解算轨迹，具体流程如下：

陀螺仪和加速度计的输出为：

其中 与分别表示预设的陀螺仪零偏与加速度计零偏，与V_n在计算参照运动轨迹已经求解获得，可以通过载体的速度以及位置求得，其计算式为其中：

图5为本发明实施例提供的获得惯性解算轨迹的流程图。如图5所示，获得惯性传感器的模拟输出与f^b后，可以进行惯性解算，得到惯性解算轨迹，具体解算流程如下：

a.根据初始姿态角求四元数初始值：

其中，θ0为载体的俯仰角的初始值，为载体的航向角的初始值，γ0为载体的横滚角的初始值，q＝[q₀ q₁ q₂ q₃]^T代表四元数。

根据四元数求方向余弦(坐标转换)矩阵由载体坐标系(b系)转换至地理坐标系(n系)：

b.运动解算：

加速度计获得的比力信息为载体坐标系中各个轴向的比力，确定惯性解算轨迹需要的比力为地理坐标系中各个轴向的比力，它们之间应用矩阵做变换：

根据比力信息可以求出各个方向上的加速度：

其中，为载体在地理坐标系下的三轴速度(即为东向速度，北向速度，天向速度)；为在地理坐标系下的三轴投影；为地球自转角速度在地理坐标系下的三轴投影；为地理坐标系相对地球坐标系的牵连角速度：其中，R为地球半径，L为当前载体的纬度，g为地球重力加速度。

利用积分可以求得载体所在位置的地理纬度L、经度λ可由下列方程求得：

其中，L₀，λ₀依次为纬度初值与经度初值。

c.四元数姿态矩阵的更新：

式中，为三轴陀螺仪所测角速度。

进一步采用毕卡逼近法更新计算的值，更新方法如下：

Δθ₀ ²＝Δθ_x ²+Δθ_y ²+Δθ_z ²

q＝[q₀ q₁ q₂ q₃]^T

其中T为系统采样间隔。

d、姿态角的求解：

姿态角与姿态矩阵的关系：

式中θ，γ，分别为俯仰角，横滚角和偏航角。记

则由以上两式即可解算出姿态角：

θ＝sin^-1(T₂₃)

重复上述流程，直至完成全部惯性传感器数据的解算。进一步可以根据惯性解算的结果与载体的参照运动轨迹做差，得到导航误差。本实施例中将轨迹设置为，载体向东进行匀加速直线运动，惯性传感器误差为：陀螺仪零偏0.1°/h，加速度计零偏1mg。惯性解算轨迹与参照运动轨迹的对比图如图6所示，其中，图6的(a)部分为载体参照轨迹示意图，图6的(b)部分为惯性解算轨迹示意图。

(4)将SINS导航误差与步骤1中的导航误差阈值进行比较，如果比较结果满足要求，则输出当前的惯性传感器精度。如果结果不满足要求，如图7所示，根据比较结果更新惯性传感器的误差，返回步骤(3)中。

首先必须要说明的是，SINS主要考虑的误差指标为姿态误差与位置误差，其中，姿态误差可以认为主要由陀螺仪误差(零偏，标度因数，安装误差)决定，其中陀螺仪零偏是其中最主要的误差源；而位置误差则由陀螺仪误差和加速度计误差(零偏，标度因数，安装误差)共同决定，其中陀螺仪零偏和加速度计零偏是其中最主要的误差源，从上述分析不难看出，应该首先分析耦合相关项较少的姿态误差(仅与陀螺仪误差相关)，再对位置误差进行分析。

本实施例中，预设的SINS姿态误差阈值与位置误差阈值依次为：和导航总时长为T_total，当前迭代得到的SINS姿态误差与位置误差最终值依次为：θ^SINS和P^SINS，陀螺仪零偏与加速度计零偏依次为：E_G和E_A，载体的参照运动轨迹的总路程为：P_total。此外，为了确保最终结果的准确性，本实施例中，E_G和E_A均被设置为较大的初值，E_G＝100°/h，E_A＝5mg，上述初值设置可以避免出现第一次运算，E_G和E_A就能满足预设误差限的情况。

如图7所示，更新过程的具体计算流程如下：

首先判断是否满足abs(θ^SINS)小于如果不满足，则计算其中，abs(·)代表求取绝对值；进一步将陀螺仪零偏修正为：E′_G＝E_G-0.6Δ_G-ε，其中ε为一个常值，为了提高修正的准确性并且加快算法收敛而设置，本实施例中，设置ε＝0.5°/h，完成修正后，将修正后的E_G和E_A返回步骤(3)重新进行计算。

如果满足abs(θ^SINS)小于进一步检测是否满足abs(P^SINS)小于如果满足abs(P^SINS)小于则将当前的E_G和E_A作为最终输出，根据当前的陀螺仪零偏和加速度计零偏进行选型。如果不满足abs(P^SINS)小于则计算和进一步依据Δ_P和对E_G和E_A进行修正，具体修正原理如下：

将加速度计零偏修正为并在上次修正的基础上，将陀螺仪零偏修正为E_G-0.6Δ_p-ε_p，其中ε_p与均为常值，为了提高修正的准确性并且加快算法收敛而设置，本实施例中，设置ε_p＝0.2°/h和将修正后的E_G和E_A返回步骤(3)重新进行计算导航误差。

本发明依据预设的误差阈值与当前的SINS导航误差之间的差值对陀螺仪零偏和加速度计零偏进行差异性修正，最终得到的陀螺仪零偏和加速度计零偏可以在满足导航精度要求的同时，具有最经济的硬件成本，可以有效辅助相关人员进行惯性传感器选型设计。本发明提供的惯性传感器选型系统的运行界面如图8所示，其中，图8的(a)部分表示轨迹生成部分的参数设定，图8的(b)部分表示导航误差阈值的设定界面，图8的(c)部分表示最终计算得到的最优惯性传感器的选型结果。

本发明充分考虑了不同的惯性传感器(陀螺仪和加速度计)对SINS误差的不同影响，根据二者的不同影响与不同特点，差异性地实现惯性传感器误差在线实时调整，可以获得SINS导航误差容许范围内的最经济的惯性传感器。

本说明书中各个实施例采用递进的方式描述，每个实施例重点说明的都是与其他实施例的不同之处，各个实施例之间相同相似部分互相参见即可。对于实施例公开的系统而言，由于其与实施例公开的方法相对应，所以描述的比较简单，相关之处参见方法部分说明即可。

本文中应用了具体个例对本发明的原理及实施方式进行了阐述，以上实施例的说明只是用于帮助理解本发明的方法及其核心思想；同时，对于本领域的一般技术人员，依据本发明的思想，在具体实施方式及应用范围上均会有改变之处。综上所述，本说明书内容不应理解为对本发明的限制。

Claims (8)

1.一种用于捷联式惯导系统的惯性传感器选型方法，其特征在于，所述捷联式惯导系统包括载体和惯性传感器，所述惯性传感器直接安装在所述载体上，所述惯性传感器包括陀螺仪和加速度计，所述选型方法包括：

获取所述捷联式惯导系统的误差阈值、所述惯性传感器误差、所述载体的姿态角速率和轨迹加速度，所述惯性传感器误差包括陀螺仪零偏和加速度计零偏；

根据所述姿态角速率和所述轨迹加速度确定所述载体的参照运动轨迹；

根据所述姿态角速率、所述轨迹加速度和所述惯性传感器误差确定所述载体的惯性解算轨迹；

根据所述参照运动轨迹和所述惯性解算轨迹确定导航误差；

判断所述导航误差是否小于所述误差阈值，获得第一判断结果；

当所述第一判断结果表示所述导航误差大于或者等于所述误差阈值时，根据所述导航误差更新所述惯性传感器误差，返回所述“根据所述姿态角速率、所述轨迹加速度和所述惯性传感器误差确定所述载体的惯性解算轨迹”；

当所述第一判断结果表示所述导航误差小于所述误差阈值时，根据所述惯性传感器误差对惯性传感器进行选型。

2.根据权利要求1所述的选型方法，其特征在于，所述根据所述导航误差更新所述惯性传感器误差，具体包括：

判断姿态误差是否大于或者等于姿态误差阈值，获得第二判断结果，所述导航误差包括姿态误差和位置误差，所述误差阈值包括姿态误差阈值和位置误差阈值；

当所述第二判断结果表示所述姿态误差大于或者等于所述姿态误差阈值时，根据所述姿态误差和所述姿态误差阈值更新所述陀螺仪零偏。

3.根据权利要求2所述的选型方法，其特征在于，当所述第二判断结果表示所述姿态误差小于所述姿态误差阈值时，判断所述位置误差是否小于所述位置误差阈值，获得第三判断结果；

当所述第三判断结果表示所述位置误差小于所述位置误差阈值时，根据当前的所述陀螺仪零偏和所述加速度计零偏对惯性传感器进行选型；

当所述第三判断结果表示所述位置误差大于或者等于位置误差阈值时，根据所述位置误差和所述位置误差阈值更新所述陀螺仪零偏和所述加速度计零偏。

4.根据权利要求2所述的选型方法，其特征在于，所述根据所述姿态误差和所述姿态误差阈值更新所述陀螺仪零偏，具体包括：

计算姿态误差差值，所述姿态误差差值为所述姿态误差的绝对值与所述姿态误差阈值的差值；

根据所述姿态误差差值更新所述陀螺仪零偏。

5.根据权利要求4所述的选型方法，其特征在于，所述根据所述姿态误差差值更新所述陀螺仪零偏，具体包括：

根据公式：确定姿态差值因子，其中，θ^SINS表示姿态误差，表示姿态误差阈值，T_total表示导航总时长，Δ_G表示姿态差值因子；

根据公式：E′_G＝E_G-0.6Δ_G-ε，更新所述陀螺仪零偏，其中，E′_G表示根据姿态误差差值更新后的陀螺仪零偏，E_G表示更新前的陀螺仪零偏，ε表示姿态误差修正因子。

6.根据权利要求5所述的选型方法，其特征在于，所述根据所述位置误差和所述位置误差阈值更新所述陀螺仪零偏和所述加速度计零偏，具体包括：

计算位置误差差值，所述位置误差差值为所述位置误差的绝对值与所述位置误差阈值的差值；

根据所述位置误差差值更新所述陀螺仪零偏和所述加速度计零偏。

7.根据权利要求6所述的选型方法，其特征在于，所述根据所述位置误差差值更新所述陀螺仪零偏和所述加速度计零偏，具体包括：

根据公式：确定陀螺仪位置差值因子，其中，Δ_P表示陀螺仪位置差值因子，P^SINS表示位置误差，表示位置误差阈值，P_total表示参照运动轨迹的总路程，T_total表示导航总时长；

根据公式：E″_G＝E′_G-0.6Δ_p-ε_p，更新所述陀螺仪零偏，其中，E″_G表示根据位置误差差值更新后的陀螺仪零偏，ε_p表示陀螺仪位置误差修正因子；

根据公式：确定加速度计位置差值因子；

根据公式：更新加速度计零偏，其中，E_A表示更新前的加速度计零偏，E′_A表示更新后的加速度计零偏，表示加速度计位置误差修正因子。

8.一种用于捷联式惯导系统的惯性传感器选型系统，其特征在于，所述捷联式惯导系统包括载体和惯性传感器，所述惯性传感器直接安装在所述载体上，所述惯性传感器包括陀螺仪和加速度计，所述选型系统包括：

数据获取模块，用于获取所述捷联式惯导系统的误差阈值、所述惯性传感器误差、所述载体的姿态角速率和轨迹加速度，所述惯性传感器误差包括陀螺仪零偏和加速度计零偏；

真实轨迹确定模块，用于根据所述姿态角速率和所述轨迹加速度确定所述载体的参照运动轨迹；

惯性解算模块，用于根据所述姿态角速率、所述轨迹加速度和所述惯性传感器误差确定所述载体的惯性解算轨迹；

导航误差确定模块，用于根据所述参照运动轨迹和所述惯性解算轨迹确定导航误差；

判断模块，用于判断所述导航误差是否小于所述误差阈值，获得第一判断结果；

选型模块，用于当所述第一判断结果表示所述导航误差小于所述误差阈值时，根据所述惯性传感器误差对惯性传感器进行选型；

传感器误差更新模块，用于当所述第一判断结果表示所述导航误差大于或者等于所述误差阈值时，根据所述导航误差更新所述惯性传感器误差。