一种MIMU组网式系统级标定方法技术方案

本发明专利技术提出一种MIMU组网式系统级标定方法。对量产后同批次MEMS惯性传感器构建的批量MIMU，建立MEMS惯性传感器的误差模型，通过多机动方式对由每个MIMU构建的捷联式惯性导航系统进行内环滤波估计获得内环滤波估计值；然后每个MIMU与其邻近多个MIMU之间进行内环滤波估计值交换，并根据自身内环滤波估计值和邻近多个MIMU的内环滤波估计值进行外环滤波估计，获得每个MIMU中MEMS惯性传感器误差模型参数，实现批量MIMU的标定。本发明专利技术克服了采用传统分立式标定方法需要依赖高精度转台以及系统级标定方法只能得到有限参数的缺陷。

A system level calibration method for MIMU networking

The invention provides a MIMU network type system level calibration method. The amount of postpartum the same batch of MEMS inertial sensors of bulk MIMU, establishing error model of MEMS inertial sensor, the strapdown inertial navigation system constructed by each MIMU inner loop filter for loop filter estimation value through multiple maneuvering mode; then each MIMU adjacent between multiple MIMU loop filter estimation value of the exchange, and according to the the inner loop filter filter estimation value and the estimated value of MIMU adjacent to a plurality of external ring filter estimation error, the MEMS inertial sensor model of each parameter in MIMU, realize the calibration quantities of MIMU. The invention overcomes the defects that the traditional vertical calibration method needs to rely on the high-precision turntable and the system level calibration method, and only the limited parameters can be obtained.

【技术实现步骤摘要】
一种MIMU组网式系统级标定方法
本专利技术属于惯性
，具体涉及一种MIMU组网式系统级标定方法。
技术介绍
在惯性
中，标定技术是一项不可或缺的核心技术。建立精确的惯性器件的数学误差模型，通过软件算法对模型误差项进行补偿可以提高惯性导航系统的精度。常见的数学误差模型的误差项有加速度计的零位偏置、陀螺仪的随机漂移、标度因数误差以及安装误差。现有的标定技术分为分立式标定方法和系统级标定方法。分立式标定方法是采用专用标定设备（一般是指具有北向和水平基准的转台）提供的角速率信息和重力加速度信息，将安装在转台上的微小型惯性测量单元（MIMU）中加速度计和陀螺仪的输出作为建模信息，依据最小二乘的原理，实现对标定参数的辨识，从而建立数学误差模型。目前分立式标定方法的理论研究较为成熟，进行多位置实验和速率实验即可完成标定。但分立式标定方法的标定精度受到MIMU中传感器的随机噪声影响，需要对同一系统重复多次标定测试并对多次标定参数取均值，才能使得标定模型参数误差的方差与惯性传感器误差的方差趋于一致。因此，传统的分立式标定方法的标定过程复杂，标定周期长，无法满足MIMU工程化的需求，同时，分立式标定无法在一次标定过程中获取同批次惯性传感器的多个样本数据，而从统计学的角度来说，传感器误差样本数量偏少，会导致标定获得的模型与实际使用过程中的真实模型不一致。因此，对于批量MIMU来说，采用分立式标定方法会存在标定时间长、标定模型参数误差不稳定的问题。系统级标定方法是基于惯性导航系统解算误差的原理进行的，惯性导航系统进入导航状态后，其参数误差经由导航解算会传递到导航结果中去，表现为导航参数误差，若能够获取导航参数误差的全部或者部分信息，就能够实现惯性导航系统标定模型参数的估计。一般而言，系统级标定方法的算法相对复杂，但是能够抑制标定过程中的测量噪声，对转台依赖程度低。目前系统级标定方法主要有两种思路，一种是基于拟合的方法，另外一种是基于参数滤波估计的方法。基于参数拟合思路的方法中需要建立特定的运动激励从而获得导航系统误差（如位置、速度等误差）与传感器模型参数之间的关系，观测导航误差，拟合估计系统误差参数，常采用最小二乘法进行拟合。这种方法中需要专用转台、北向基准等基准设备提供特定的运动激励，标定周期长，步骤相对繁琐。基于参数滤波思路的方法中，一般设计滤波器时将惯性器件的模型参数作为滤波器的状态量，通过观测导航误差，滤波估计各标定模型参数项，常采用Kalman滤波器进行状态估计。这种方法通常只能够估计出加速度计的零位偏置和陀螺仪的零位漂移，因此可以获得的标定模型参数有限。对批量的MIMU进行标定时，若采用分立式标定方法，需要通过专用转台或者其他高精度的基准设备进行多位置实验和速率实验来完成，若采用系统级标定方法，就必须解决标定的模型参数有限的问题。
技术实现思路
本专利技术提出一种MIMU组网式系统级标定方法，解决了基于MEMS惯性传感器构建的MIMU批量标定问题，克服了采用传统分立式标定方法需要依赖高精度转台以及系统级标定方法只能得到有限参数的缺陷。为了解决上述技术问题，本专利技术提供一种MIMU组网式系统级标定方法对量产后同批次MEMS惯性传感器构建的批量MIMU，建立MEMS惯性传感器的误差模型，通过多机动方式对由每个MIMU构建的捷联式惯性导航系统进行内环滤波估计获得内环滤波估计值；然后每个MIMU与其邻近多个MIMU之间进行内环滤波估计值交换，并根据自身内环滤波估计值和邻近多个MIMU的内环滤波估计值进行外环滤波估计，获得每个MIMU中MEMS惯性传感器误差模型参数，实现批量MIMU的标定。本专利技术与现有技术相比，其显著优点在于：（1）本专利技术中通过对测试平台采用多种机动方式进行激励（加速、减速、转弯、直行等），从捷联式惯性导航方法解算的结果中估计出模型参数，将MIMU的模型参数标定问题转化为模型参数的估计，因此无需专业转台支持，对标定设备要求降低，并缩短了批量MIMU的标定周期；（2）本专利技术能够实现在一次标定过程中对多个基于同批次MEMS惯性传感器的MIMU进行标定，从统计学的角度讲，可以同时获取同批次多个惯性传感器的输出，满足这一批传感器同一时刻的概率分布特性，有利于MIMU标定模型的稳定性，实现标定后的MIMU输出误差概率与惯性传感器误差概率一致；（3）本专利技术在对MIMU的模型参数进行估计时采用内环滤波估计环节和外环滤波估计环节，提高了单个MIMU系统级标定时单内环滤波估计环节的估计精度。附图说明图1为使用本专利技术方法进行模型参数标定时多个MIMU在测试平台上的安装示意图。图2为本专利技术中各数据流向示意图。图3为本专利技术中内环滤波估计的计算流程图。图4为本专利技术中外环滤波估计的计算流程图。具体实施方式本专利技术为一种MIMU组网式系统级标定方法，对量产后同批次MEMS惯性传感器构建的批量MIMU，建立MEMS惯性传感器的误差模型，通过多机动方式（例如：加速、减速、转弯、直行等）对由每个MIMU构建的捷联式惯性导航系统进行内环滤波估计获得内环滤波估计值，即获得MIMU标定模型参数的初步估计值；然后每个MIMU与其邻近多个MIMU之间进行内环滤波估计值交换，并根据自身内环滤波估计值和邻近多个MIMU的内环滤波估计值进行外环滤波估计，即利用邻近的多个MIMU的内环滤波估计信息和观测信息对其模型参数的初步估计值进行修正，获得每个MIMU中MEMS惯性传感器误差模型的参数的最优估计，从而实现批量MIMU的标定。本专利技术方法具体包括以下步骤：步骤一、如图1所示，将待测MIMU分别安置于同一刚性测试平台内的安装基准上，调整各个待测MIMU的基准面与安装基准吻合；在中心计算机中建立MEMS惯性传感器的误差模型；步骤二、根据预先设定的采样周期、滤波周期以及测试平台的机动方式（机动方式可以包括加速、减速、转弯、直行运动等）对测试平台进行激励，在测试平台机动过程中采集每个MIMU中MEMS惯性传感器的输出值并将输出值送入中心计算机；步骤三、中心计算机中对MEMS惯性传感器的输出值采用捷联式惯性导航方法进行导航解算，获得MIMU的速度、位置、姿态；并建立内环滤波估计环节的系统状态方程和系统测量方程；步骤四、中心计算机进行内环滤波估计获得每个MIMU的内环滤波估计值，内环滤波估计值包括每个MIMU的内环滤波估计环节的状态量一步预测值、一步预测均方误差、滤波增益值以及内环滤波估计环节的状态估计值；然后，如图2所示，在每个MIMU与其邻近的多个MIMU之间交换内环滤波估计环节的状态量一步预测值、一步预测均方误差、滤波增益值；步骤五、中心计算机根据每个MIMU获得的邻近多个MIMU的内环滤波估计环节的状态量一步预测值、一步预测均方误差、滤波增益值，对每个MIMU进行外环滤波估计，获得每个MIMU中MEMS惯性传感器误差模型参数的精确估计值；步骤六、中心计算机将误差模型参数的精确估计值返回给各个MIMU，使用测试平台的运动激励验证每个MIMU中MEMS惯性传感器误差模型参数精确估计值的准确度，并计算MEMS惯性传感器误差模型参数的误差方差；步骤七、将步骤六获得的每个MIMU中MEMS惯性传感器误差模型参数的误差方差与预先设定的误差方差阈值进行比较，若误差本文档来自技高网...

【技术保护点】
一种MIMU组网式系统级标定方法，其特征在于，包括以下步骤：步骤一、将待测MIMU分别安置于同一刚性测试平台内的安装基准上，调整各个待测MIMU的基准面与安装基准吻合；在中心计算机中建立MEMS惯性传感器的误差模型；步骤二、根据预先设定的采样周期、滤波周期以及测试平台的机动方式对测试平台进行激励，在测试平台机动过程中采集每个MIMU中MEMS惯性传感器的输出值并将输出值送入中心计算机；步骤三、中心计算机中对MEMS惯性传感器的输出值采用捷联式惯性导航方法进行导航解算，获得MIMU的速度、位置、姿态；并建立内环滤波估计环节的系统状态方程和系统测量方程；步骤四、中心计算机进行内环滤波估计获得每个MIMU的内环滤波估计值，内环滤波估计值包括每个MIMU的内环滤波估计环节的状态量一步预测值、一步预测均方误差、滤波增益值以及内环滤波估计环节的状态估计值；然后在每个MIMU与其邻近的多个MIMU之间交换内环滤波估计环节的状态量一步预测值、一步预测均方误差、滤波增益值；步骤五、中心计算机根据每个MIMU获得的邻近多个MIMU的内环滤波估计环节的状态量一步预测值、一步预测均方误差、滤波增益值，对每个MIMU进行外环滤波估计，获得每个MIMU中MEMS惯性传感器误差模型参数的精确估计值；步骤六、中心计算机将误差模型参数的精确估计值返回给各个MIMU，使用测试平台的运动激励验证每个MIMU中MEMS惯性传感器误差模型参数精确估计值的准确度，并计算MEMS惯性传感器误差模型参数的误差方差；步骤七、将步骤六获得的每个MIMU中MEMS惯性传感器误差模型参数的误差方差与预先设定的误差方差阈值进行比较，若误差方差大于误差方差阈值，则返回步骤三；若误差方差不大于误差方差阈值，则把MIMU外环滤波估计获得的模型参数的精确估计值作为每个MIMU中MEMS惯性传感器误差模型的标定结果，完成对批量MIMU的标定。...

【技术特征摘要】
1.一种MIMU组网式系统级标定方法，其特征在于，包括以下步骤：步骤一、将待测MIMU分别安置于同一刚性测试平台内的安装基准上，调整各个待测MIMU的基准面与安装基准吻合；在中心计算机中建立MEMS惯性传感器的误差模型；步骤二、根据预先设定的采样周期、滤波周期以及测试平台的机动方式对测试平台进行激励，在测试平台机动过程中采集每个MIMU中MEMS惯性传感器的输出值并将输出值送入中心计算机；步骤三、中心计算机中对MEMS惯性传感器的输出值采用捷联式惯性导航方法进行导航解算，获得MIMU的速度、位置、姿态；并建立内环滤波估计环节的系统状态方程和系统测量方程；步骤四、中心计算机进行内环滤波估计获得每个MIMU的内环滤波估计值，内环滤波估计值包括每个MIMU的内环滤波估计环节的状态量一步预测值、一步预测均方误差、滤波增益值以及内环滤波估计环节的状态估计值；然后在每个MIMU与其邻近的多个MIMU之间交换内环滤波估计环节的状态量一步预测值、一步预测均方误差、滤波增益值；步骤五、中心计算机根据每个MIMU获得的邻近多个MIMU的内环滤波估计环节的状态量一步预测值、一步预测均方误差、滤波增益值，对每个MIMU进行外环滤波估计，获得每个MIMU中MEMS惯性传感器误差模型参数的精确估计值；步骤六、中心计算机将误差模型参数的精确估计值返回给各个MIMU，使用测试平台的运动激励验证每个MIMU中MEMS惯性传感器误差模型参数精确估计值的准确度，并计算MEMS惯性传感器误差模型参数的误差方差；步骤七、将步骤六获得的每个MIMU中MEMS惯性传感器误差模型参数的误差方差与预先设定的误差方差阈值进行比较，若误差方差大于误差方差阈值，则返回步骤三；若误差方差不大于误差方差阈值，则把MIMU外环滤波估计获得的模型参数的精确估计值作为每个MIMU中MEMS惯性传感器误差模型的标定结果，完成对批量MIMU的标定。2.如权利要求1所述的MIMU组网式系统级标定方法，其特征在于，所述MEMS惯性传感器的误差模型包括加速度计误差模型和陀螺仪误差模型，所述加速度计误差模型如公式(1)所示，公式(1)中，Ax、Ay、Az分别为MIMU中x、y、z三个轴向加速度计的比力输出；δKAx、δKAy、δKAz分别为MIMU中x、y、z三个轴向加速度计的标度因数误差；δAx、δAy、δAz分别为MIMU中x、y、z三个轴向加速度计的安装误差系数；ax、ay、az分别为x、y、z三个轴向真实的比力输入；Ax0、Ay0、Az0分别为MIMU中x、y、z三个轴向加速度计的零位偏置；所述陀螺仪误差模型如公式(2)所示，公式(2)中，Ωx、Ωy、Ωz分别为MIMU中x、y、z三个轴向陀螺仪的角速率输出；δKGx、δKGy、δKGz分别为MIMU中x、y、z三个轴向陀螺仪的标度因数误差；δGx、δGy、δGz分别为MIMU中x、y、z三个轴向陀螺仪的安装误差系数；ωx、ωy、ωz分别表示x、y、z三个轴向真实的角速率输入；ωx0、ωy0、ωz0分别为MIMU中x、y、z三个轴向陀螺仪的零位漂移。3.如权利要求1所述的MIMU组网式系统级标定方法，其特征在于，所述步骤二中，在对测试平台进行激励之前，对MIMU通电预热30分钟，设定采样周期为0.01秒。4.如权利要求1所述的MIMU组网式系统级标定方法，其特征在于，所述中心计算机为嵌入式处理器、可移动终端、笔记本电脑中的一种。5.如权利要求1所述的MIMU组网式系统级标定方法，其特征在于，每个MIMU与其邻近的四个MIMU之间交换内环滤波估计环节的状态量一步预测值、一步预测均方误差、滤波增益值。6.如权利要求1所述的MIMU组网式系统级标定方法，其特征在于，所述步骤四中进行内环滤波估的滤波器为Kalman滤波器；滤波模型包括由MIMU构建的捷联式惯性导航系统的内环滤波估计环节的状态方程和观测方程；所述内环滤波估计环节的状态方程如公式(3)所示：公式(3)中，X为由MIMU构建的捷联式惯性导航系统的状态矢量，为系统状态矢量的微分，W为系统激励噪声矢量，F为系统转移矩阵；所述内环滤波估计环节的状态方程的状态量包括：捷联式惯性导航方法解算的速度误差、位置误差、姿态误差；待标定的MIMU中的MEMS加速度计的零位偏置、标度因数误差、安装误差以及MEMS陀螺仪的常值漂移、标度因数误差和安装误差；所述内环滤...

【专利技术属性】
技术研发人员：王宇，吴志强，徐云，朱欣华，
申请(专利权)人：南京理工大学，
类型：发明
国别省市：江苏,32