一种基于模观测法的离心机加速度计组合标定方法研究

2021-12-02王世明李梦真

导航定位与授时 2021年6期

王世明，李梦真

(天津科技大学电子信息与自动化学院，天津 300222)

0 引言

加速度计在惯性导航系统中处于核心地位，用于精确给出运载体相应的位置信息。因此，提高加速度计的标定精度是提高惯导系统导航精度的必要条件[1]。目前，针对惯导系统中加速度计的标定方法主要为分立法且大部分在重力场下进行，通过在拆卸安装仪表的过程中引入安装误差角来影响标定精度；重力场下可提供加速度计的最大输入比力为1g，不足以有效激励加速度计的高阶项误差参数，不满足高加速度飞行的导航条件[2-4]。因此，大激励且整体标定加速度计是惯性仪表标定研究的主流。

整体法标定旨在标定加速度计组合全部误差模型系数的同时，降低测试设备误差对系数标定精度的影响。荷兰学者J.C.Lötters等[5]提出了一种利用模观测标定方法很好地解决过度依赖转台的问题，大大降低了转台误差对误差模型系数标定结果的影响；董春梅等[6]在此基础上利用模观测法在重力场下标定了单一陀螺仪和加速度计的零偏、一阶标度因数，重点分离了安装误差在标定过程中的影响；戴邵武等[7]将导航姿态解算引入微惯性测量单元(Micro Inertial Measurement Unit，MIMU)的标定中，提出了在MIMU转动过程中采用四元数进行姿态解算，静止时列写MIMU标定模观测非线性方程的方法，实现了待标定参数的完全激励，并将基于Logistic函数的改进粒子群优化(Particle Sw-arm Optimization，PSO)算法应用于MIMU的标定；王世明等[8]引入了一种无转台标定中高精度惯导系统的方法，依据正交轴上加速度计输出的矢量和等于重力的原理，标定出加速度计输出模型中的相关参数；张红良等[9]推导了基于高精度转台的惯性测量单元(Inertial Measurement Unit，IMU)标定方法的误差解析式，提出了一种抑制转台误差的标定编排改进方案，建立了IMU标定参数模型，并研究了静态多位置IMU模观测标定方法。上述模观测法仍在重力静力场或转台低转速模式下进行研究，误差模型中不包含高次项系数，无法适应惯导系统高加速度飞行的应用环境。

精密离心机能够持续提供大于1g的高精确度的加速度，通常用于辨识加速度计的高阶系数模型[10-11]，为得到带有高阶项的加速度计系数模型奠定了良好的基础。但是，标定方法的差异对标定精度产生了一定的影响，实际标定过程中常需要设计相应的测试方法[12-14]对其产生的误差进行补偿、规避、抑制甚至消除。

基于模观测法的标定思想，以高速旋转的精密离心机作为标定设备，研究加速度计组合的整体标定方法，重点研究模观测法对加速度计二次项系数的标定原理，借助Tylor级数展开和最小二乘法[15-16]等数学方法，给出误差模型系数标定结果的数学表达，同时考虑安装误差角和杆臂误差对标定结果精度的影响，为提高惯性组合标定精度打下基础。

1 标定设备

为准确标定各项系数，选用带有反转平台的高精度离心机作为标定设备，建立此系统的坐标系及结构图如图1所示。此系统的地理(主轴)坐标系为OnXnYnZn，主轴轴套坐标系为O0X0Y0Z0，水平轴坐标系为O2X2Y2Z2，水平轴轴套坐标系为O2tX2tY2tZ2t。

图1 加速度计组合结构示意图Fig.1 Schematic diagram of inertial assembly structure for centrifuge calibration

加速度计组合内部加速度计各轴的取向如图2所示。

图2 加速度计组合内部示意图 Fig.2 Internal schematic diagram of accelerometer combination

2 标定设备离心机模观测法标定原理

IMU在重力场静态条件下的输入比力满足[7]

(1)

应用模观测法，对式(1)两边分别取模，得

(2)

类似地,在离心机上进行加速度计标定时输入比力满足

(3)

应用模观测法，对式(3)两边分别取模，得

(4)

由式(4)可知，在离心机标定加速度计组合时，3个方向加速度计输入比力的合成等于向心加速度和重力加速度的合成，可用式(5)进一步表示

(5)

其中，A=ω2R，ω为离心机旋转角速度，R为半径标称值。

由于加速度计的输出值与输入比力正相关。因此，只要获得加速度计输出值，就可以通过取模的方式构建辨识加速度计误差模型系数的条件。

3 加速度计的模型

考虑一阶及二阶误差模型系数，则加速度计的误差模型如式(6)所示

Na=Ka[fb+Da(fb)2]+ba+na

(6)

其中，Ka=SaΦa，代入即可建立加速度计的误差模型分解形式

SaΦa[fb+Da(fb)2]=(Na-ba-na)

(7)

Naz]T为加速度计输出值；ba=[baxbaybaz]T为零偏；na=[naxnaynaz]T为测量误差。

4 模观测法标定加速度计组合方法

对式(7)进行化简，并忽略高阶无穷小项，可得

(8)

式中

(9)

式(8)为3个加速度计输入比力的二元一次方程，利用求根公式并根据输入比力的值为正，舍去数值为负的一项，计算输入比力的表达式为

(10)

从式(10)可知，3个加速度计的输入比力与(1-4DaΔ)0.5相关，该项表达式在参数辨识过程中不易于参数分离，因此考虑将式(10)用Tylor级数展开式展开。通过数值仿真可知，Tylor级数展开至第二项后，输入比力的误差与真值偏差小于10-4量级，满足加速度计输出精度要求，故以展开至二次项系数为输入比力关系表达式，可得

(11)

若以g为计量单位，将式(11)代入式(5)中，忽略高阶无穷小项，同时忽略安装误差角的影响，可得

(12)

(13)

式中

(14)

根据式(13)可知，若标定过程中给予加速度计组合不同的测试位置，则可以获得若干个加速度计的输出，通常测试位置数N≥4n+2，n为拟辨识系数个数。式(13)中,C为待辨识参数，共13项，故测试位置数N至少为54个。则可得出N个方程，可表示为

(15)

式中

进而利用最小二乘法，可得13项待辨识参数的计算公式为

(16)

通过观察式(15)系数之间的关系,可知

(17)

(18)

则可解得

(19)

进而可求得3个加速度计的标度因数为

(20)

3个加速度计的二次项系数为

(21)

3个加速度计的零偏为

(22)

至此，误差模型(5)中的待标定系数的表达式如式(20)～式(22)所示。实际标定过程中，通过设定多位置，采集3个加速度计在不同位置的输出，按照式(16)～式(22)的计算过程即可完成对加速度计组合的整体标定，特别实现了模观测法对加速度计二次项系数的标定。

5 实验仿真与误差分析

设置仿真条件：假设如图1所示离心机标称半径为1m，g为9.8 m/s2，实验当地纬度为北纬39°。

拟选用的加速度计标度因数分别为

Sax=1.29，Say=1.21 ，Saz=1.26

加速度计零偏分别为

bax=0.213g，bay=0.256g，baz=0.516g

加速度计二次项系数分别为

Dax=0.57 ×10-4g/g2，Day=0.31×10-4g/g2，Daz=0.45×10-4g/g2

加速度计测量噪声为10-5V 。采集测试位置数N为60个，此时N>54，故满足要求。加速度计的三轴转向具体示意图如图3所示，仿真过程中各加速度计具体输出如表1所示。

根据式(8)～式(22)，在不考虑安装误差角和杆臂误差的情况下，可得出3个加速度计零偏、标度因数以及二次项系数的具体数值。仿真标定结果如表2所示。

图3 20位置下3个加速度计的输入轴指向示意图Fig.3 Schematic diagram of the input axis of the three accelerometers at 20 positions

表1 20位置下3个加速度计不同离心机转速下的实际输出

续表

表2 仿真标定结果(不考虑安装误差与杆臂误差)

1)考虑安装误差角

将式(9)代入式(10)～式(12)中，可得带误差项且校正过的输入比力表达式，如式(23)所示

(23)

其中

由此可知，安装误差角主要影响式(14)中的C11、C12和C13项，而应用式(17)～式(22)计算各误差模型系数时对各系数标定结果均有影响。设3个加速度计安装误差角的变化范围从2×10-4rad～10×10-4rad，计算安装误差角对标度因数、二次项系数以及零偏的影响，如图4所示。

由图4中可知，随着安装误差角的增大，其对所有误差模型系数标定精度的影响也随之增大。其中，误差角的存在对3个加速度计的标度因数影响最大，对零偏的影响次之，对二次项系数的影响最小。从影响大小的角度分析，安装误差角的影响远小于误差模型系数的精度要求。因此，实际标定过程中，可以忽略安装误差角对误差模型系数标定精度的影响。

2)考虑杆臂误差