CN113987746A - Hemispherical resonator gyroscope use performance improving method based on collective theory - Google Patents

Hemispherical resonator gyroscope use performance improving method based on collective theory Download PDF

Info

Publication number
CN113987746A
CN113987746A CN202111116062.5A CN202111116062A CN113987746A CN 113987746 A CN113987746 A CN 113987746A CN 202111116062 A CN202111116062 A CN 202111116062A CN 113987746 A CN113987746 A CN 113987746A
Authority
CN
China
Prior art keywords
model
ellipsoid
noise
data
hemispherical resonator
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.)
Pending
Application number
CN202111116062.5A
Other languages
Chinese (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.)
Rocket Force University of Engineering of PLA
Original Assignee
Rocket Force University of Engineering of PLA
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 Rocket Force University of Engineering of PLA filed Critical Rocket Force University of Engineering of PLA
Priority to CN202111116062.5A priority Critical patent/CN113987746A/en
Publication of CN113987746A publication Critical patent/CN113987746A/en
Pending legal-status Critical Current

Links

Images

Classifications

    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06FELECTRIC DIGITAL DATA PROCESSING
    • G06F30/00Computer-aided design [CAD]
    • G06F30/20Design optimisation, verification or simulation
    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06FELECTRIC DIGITAL DATA PROCESSING
    • G06F17/00Digital computing or data processing equipment or methods, specially adapted for specific functions
    • G06F17/10Complex mathematical operations
    • G06F17/11Complex mathematical operations for solving equations, e.g. nonlinear equations, general mathematical optimization problems
    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06FELECTRIC DIGITAL DATA PROCESSING
    • G06F17/00Digital computing or data processing equipment or methods, specially adapted for specific functions
    • G06F17/10Complex mathematical operations
    • G06F17/16Matrix or vector computation, e.g. matrix-matrix or matrix-vector multiplication, matrix factorization
    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06FELECTRIC DIGITAL DATA PROCESSING
    • G06F2119/00Details relating to the type or aim of the analysis or the optimisation
    • G06F2119/10Noise analysis or noise optimisation

Landscapes

  • Engineering & Computer Science (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Mathematical Physics (AREA)
  • Theoretical Computer Science (AREA)
  • Data Mining & Analysis (AREA)
  • Mathematical Optimization (AREA)
  • Computational Mathematics (AREA)
  • Pure & Applied Mathematics (AREA)
  • Mathematical Analysis (AREA)
  • General Engineering & Computer Science (AREA)
  • Software Systems (AREA)
  • Databases & Information Systems (AREA)
  • Algebra (AREA)
  • Operations Research (AREA)
  • Computing Systems (AREA)
  • Computer Hardware Design (AREA)
  • Evolutionary Computation (AREA)
  • Geometry (AREA)
  • Gyroscopes (AREA)

Abstract

The invention discloses a hemispherical resonator gyroscope usability improving method based on collective theory, which comprises the steps of testing static output data of a hemispherical resonator gyroscope, analyzing the obtained data, establishing a time sequence model of random drift of the data, realizing dynamic identification of model parameters aiming at the characteristic that the model changes along with time, estimating an accurate angular rate signal by using an improved collective filtering algorithm, and realizing suppression of random drift errors, thereby improving the usability of the hemispherical resonator gyroscope, and specifically comprising the steps of establishing a random error model, filtering the random errors and evaluating and analyzing the promotion effect. The method has the advantages that the accuracy and the reliability of inhibiting the random drift can be improved, so that the service performance of the method is obviously improved.

Description

一种基于集员理论的半球谐振陀螺仪使用性能提升方法A performance improvement method for hemispheric resonant gyroscope based on set membership theory

技术领域technical field

本发明属于惯性导航技术领域,具体涉及一种基于集员理论的半球谐振陀螺仪使用性能提升方法。The invention belongs to the technical field of inertial navigation, and in particular relates to a method for improving the use performance of a hemispherical resonant gyroscope based on the set membership theory.

背景技术Background technique

半球谐振陀螺具有寿命长、启动时间短、长期稳定性好等突出优点,因而在卫星、空间工作站、探测器等领域受到高度重视。但是,由于国内研究起步较晚以及工艺水平较低的限制,精度相对偏低,难以满足现代战争中高精度的军事应用需求。为提高其使用性能,一种思路是改进其生产工艺、结构和电路,如专利“Gyroscope and devices withstructural components comprising HfO2-TiO2 material”(US9719168B2)发明了一种含HfO2-TiO2材料的半球谐振子,可具有良好的振动品质;专利“一种半球谐振陀螺精密装调和检测装置”(CN211346826U)可实现谐振子与电极基座之间的相对位置和相对角度的六维自由度精密调整,并可实时进行闭环反馈,提高装调精度。这类方法对于提高陀螺仪性能的效果是显著的,但是,通过这类方法提高陀螺仪性能的方法成本高、周期长,且难度较大。因此,基于现有的硬件水平,通过误差建模补偿的方式迅速提高半球谐振陀螺仪的使用性能,对于拓展半球谐振陀螺仪的应用范围,为制导武器提供高精度的惯性导航具有重要意义。如“基于ARMA-AKF的HRG随机误差建模分析”(《压电与声光》39卷第1期)一文提出了一种基于自回归滑动平均模型和自适应卡尔曼滤波模型的陀螺仪随机误差处理方法,专利“一种车载MEMS陀螺仪随机漂移误差的抑制方法”(CN111561930A)发明了一种陀螺仪随机漂移误差的处理方法,通过时序建模和多次卡尔曼滤波处理对干扰噪声进行了有效的抑制。这些方法在一定程度上有效提高了陀螺仪的精度。但是,他们所采用的辨识和滤波方法对噪声的分布都有严格的要求,而在实际应用中,陀螺噪声的统计特性往往相当复杂,实时变化,甚至可能存在异方差、混沌噪声等不确定统计特性的噪声,导致概率分布假设很难得到满足或统计特性难以确定,这种情况会造成估计的偏差,导致估计器不稳定,因而,需要提供一种新的随机误差建模和滤波方法,克服传统滤波方法的缺陷,进一步提升半球谐振陀螺仪的使用性能。Hemispherical resonant gyroscopes have outstanding advantages such as long life, short start-up time, and good long-term stability, so they are highly valued in the fields of satellites, space workstations, and detectors. However, due to the late start of domestic research and the limitation of low technological level, the accuracy is relatively low, and it is difficult to meet the military application requirements of high precision in modern warfare. In order to improve its performance, one idea is to improve its production process, structure and circuit. For example, the patent "Gyroscope and devices with structural components comprising HfO 2 -TiO 2 material" (US9719168B2) invented a kind of HfO 2 -TiO 2 material containing HfO 2 -TiO 2 material. The hemispherical resonator can have good vibration quality; the patent "Precision Assembly and Detection Device of Hemispherical Resonant Gyroscope" (CN211346826U) can realize the six-dimensional precise adjustment of the relative position and relative angle between the resonator and the electrode base , and can perform closed-loop feedback in real time to improve the adjustment accuracy. This kind of method has a remarkable effect on improving the performance of the gyroscope. However, the method of improving the performance of the gyroscope by this method has high cost, long period and great difficulty. Therefore, based on the existing hardware level, it is of great significance to rapidly improve the performance of the hemispherical resonant gyroscope by means of error modeling and compensation, which is of great significance to expand the application range of the hemispherical resonant gyroscope and provide high-precision inertial navigation for guided weapons. For example, the article "Modeling Analysis of HRG Stochastic Error Based on ARMA-AKF"("Piezoelectric and Acousto-Optics" Volume 39 No. 1) proposed a gyroscope random error based on the autoregressive moving average model and the adaptive Kalman filter model. Error processing method, the patent "A method for suppressing random drift error of vehicle-mounted MEMS gyroscope" (CN111561930A) invented a method for processing random drift error of gyroscope. effective suppression. These methods effectively improve the accuracy of the gyroscope to a certain extent. However, the identification and filtering methods they use have strict requirements on the distribution of noise. In practical applications, the statistical characteristics of gyro noise are often quite complex, changing in real time, and there may even be uncertain statistics such as heteroscedasticity and chaotic noise. The noise of the characteristic makes the probability distribution assumption difficult to be satisfied or the statistical characteristics are difficult to determine. This situation will cause the estimation bias and lead to the instability of the estimator. Therefore, it is necessary to provide a new random error modeling and filtering method to overcome the The defects of the traditional filtering method further improve the performance of the hemispherical resonant gyroscope.

发明内容SUMMARY OF THE INVENTION

针对上述的问题和对半球谐振陀螺性能的分析研究,本发明的目的在于:提供一种基于集员理论的半球谐振陀螺仪使用性能提升方法,通过集员辨识和集员滤波实现半球谐振陀螺仪的随机误差建模与补偿,克服传统辨识和滤波方法的局限,在现有硬件基础上进一步提高半球谐振陀螺仪的使用性能。In view of the above-mentioned problems and the analysis and research on the performance of the hemispherical resonant gyroscope, the purpose of the present invention is to provide a method for improving the performance of the hemispherical resonant gyroscope based on the set membership theory, and to realize the hemispherical resonant gyroscope through the set membership identification and the set membership filtering. It overcomes the limitations of traditional identification and filtering methods, and further improves the performance of hemispheric resonant gyroscopes on the basis of existing hardware.

本发明采用的技术方案是:The technical scheme adopted in the present invention is:

一种基于集员理论的半球谐振陀螺仪使用性能提升方法,包括以下步骤:A method for improving the performance of a hemispherical resonant gyroscope based on the set membership theory, including the following steps:

步骤1:建立随机误差模型;Step 1: Build a random error model;

步骤2:随机误差滤波;Step 2: Random error filtering;

步骤3:提升效果评估分析Step 3: Evaluation and analysis of improvement effect

通过步骤2得到的估计结果是半球谐振陀螺所敏感的真实角速率的所有可能的集合,集合的形状为椭球,将椭球中心作为点估计结果分析漂移抑制情况,使用估计结果的均方根误差和零偏不稳定性表征半球谐振陀螺仪漂移大小的指标;使用改善因子描述陀螺仪使用精度提升效果,改善因子定义为:The estimation result obtained in step 2 is all possible sets of the true angular velocity to which the hemispherical resonant gyroscope is sensitive. The shape of the set is an ellipsoid, and the center of the ellipsoid is used as the point estimation result to analyze the drift suppression situation, and the root mean square of the estimation result is used. Error and bias instability are indicators that characterize the drift of the hemispherical resonant gyroscope; the improvement factor is used to describe the effect of improving the accuracy of the gyroscope, and the improvement factor is defined as:

Figure BDA0003275360680000021
Figure BDA0003275360680000021

其中,Index1表示抑制后的随机误差指标,Index0表示抑制前的随机误差指标。Among them, Index 1 represents the random error index after suppression, and Index 0 represents the random error index before suppression.

优选的,在步骤1中,采集半球谐振陀螺静态输出数据,对数据进行预处理之后通过时间序列分析方法建立样本数据的误差模型,并利用集员辨识方法对模型参数进行辨识,得到半球谐振陀螺基于有界噪声假设的随机误差模型,具体包括以下步骤:Preferably, in step 1, the static output data of the hemispherical resonant gyroscope is collected, the error model of the sample data is established by the time series analysis method after the data is preprocessed, and the model parameters are identified by the set membership identification method to obtain the hemispherical resonant gyroscope. The random error model based on the assumption of bounded noise includes the following steps:

步骤101:数据预处理Step 101: Data Preprocessing

静止状态下采集半球谐振陀螺输出数据后,使用3σ准则进行粗大误差剔除,并采用单位根检验方法对输出数据序列进行平稳性检验;如果检验结果为非平稳序列,则对数据进行差分处理:After collecting the output data of the hemispherical resonant gyroscope in a static state, the 3σ criterion is used to eliminate the gross errors, and the unit root test method is used to test the stationarity of the output data sequence; if the test result is a non-stationary sequence, the data is subjected to differential processing:

y′k=yk+1-yk y′ k =y k+1 -y k

其中,yk为原始输出数据,y′k为差分后的数据,对差分处理后的数据采用单位根检验方法进行平稳性检验,如果检验结果为平稳序列,数据预处理结束;如果结果为非平稳序列,则继续进行差分处理,直至单位根检验结果为平稳序列;Among them, y k is the original output data, y' k is the differenced data, and the unit root test method is used to test the stationarity of the differenced data. If the test result is a stationary sequence, the data preprocessing ends; if the result is not If the sequence is stationary, continue to perform differential processing until the unit root test result is a stationary sequence;

步骤102:确定模型阶次Step 102: Determine the model order

首先对经过预处理的数据序列进行自相关特征和偏相关特征分析确定模型结构,然后利用贝叶斯信息准则来确定阶数;Firstly, the autocorrelation feature and partial correlation feature analysis of the preprocessed data sequence is carried out to determine the model structure, and then the Bayesian information criterion is used to determine the order;

步骤103:模型参数辨识Step 103: Model parameter identification

根据模型结构和阶数给出具体的模型方程,并将其转换为广义回归模型的形式;通过观测数据得到噪声的边界,并设定模型参数的初值;最后通过定界椭球自适应约束最小二乘法对模型参数进行动态辨识,得到包含参数可行集的椭球,以椭球中心作为模型的估计参数,建立最终的误差模型。The specific model equation is given according to the model structure and order, and it is converted into the form of a generalized regression model; the boundary of the noise is obtained through the observation data, and the initial value of the model parameters is set; finally, the bound ellipsoid is adaptively constrained The least squares method is used to dynamically identify the model parameters, and an ellipsoid containing a feasible set of parameters is obtained. The center of the ellipsoid is used as the estimated parameter of the model to establish the final error model.

优选的,其特征在于,在步骤102中,贝叶斯信息准则函数表示为:Preferably, in step 102, the Bayesian information criterion function is expressed as:

Figure BDA0003275360680000031
Figure BDA0003275360680000031

式中:N为样本长度;

Figure BDA0003275360680000032
为残差序列;p为模型阶次;则In the formula: N is the sample length;
Figure BDA0003275360680000032
is the residual sequence; p is the model order; then

Figure BDA0003275360680000033
Figure BDA0003275360680000033

通过上式搜索得到BIC最小值,则i为AR部分阶数,减小MA部分阶数,重复该过程,可确定最终模型阶数。The minimum value of BIC is obtained through the search of the above formula, then i is the order of the AR part, reducing the order of the MA part, and repeating this process, the final model order can be determined.

优选的,其特征在于,步骤103具体操作步骤包括:Preferably, it is characterized in that the specific operation steps of step 103 include:

(1)建立随机误差时间序列模型ARMA:(1) Establish a random error time series model ARMA:

Figure BDA0003275360680000041
Figure BDA0003275360680000041

其中,yk陀螺漂移序列,n为AR模型阶数,m为MA模型阶数,ai、bj为待定模型参数,wk为均值为零的可加测量噪声;Among them, y k gyro drift sequence, n is the AR model order, m is the MA model order, a i and b j are undetermined model parameters, and w k is the additive measurement noise with zero mean;

将随机误差时间序列模型转换为广义回归模型:Convert a random error time series model to a generalized regression model:

Figure BDA0003275360680000042
Figure BDA0003275360680000042

其中,Φ为时间序列和噪声矩阵,θ为待定参数向量;若wk是有界的,满足|wk|2<γ2Among them, Φ is the time series and noise matrix, θ is the undetermined parameter vector; if w k is bounded, it satisfies |w k | 22 ;

同时,假设待辨识的参数初值属于椭球:At the same time, it is assumed that the initial value of the parameter to be identified belongs to an ellipsoid:

Figure BDA0003275360680000043
Figure BDA0003275360680000043

其中,

Figure BDA0003275360680000044
为椭球的中心,M0为正定矩阵,定义了椭球的形状;in,
Figure BDA0003275360680000044
is the center of the ellipsoid, M 0 is a positive definite matrix, which defines the shape of the ellipsoid;

(2)然后利用外包椭球来逼近参数可行集,包含参数可行集的椭球可通过如下过程递推得到(2) Then use the outsourcing ellipsoid to approximate the parameter feasible set, and the ellipsoid containing the parameter feasible set can be obtained recursively through the following process

Figure BDA0003275360680000045
Figure BDA0003275360680000045

Figure BDA0003275360680000046
Figure BDA0003275360680000046

Figure BDA0003275360680000047
Figure BDA0003275360680000047

Figure BDA0003275360680000048
Figure BDA0003275360680000048

其中,

Figure BDA0003275360680000049
Figure BDA00032753606800000410
λk≥0,后续步骤中以参数可行集的椭球中心作为模型参数。in,
Figure BDA0003275360680000049
Figure BDA00032753606800000410
λ k ≥ 0, in the subsequent steps, the ellipsoid center of the parameter feasible set is used as the model parameter.

优选的,在步骤2中,利用建立的随机误差模型,转化得到半球谐振陀螺的空间状态方程,通过集员滤波算法估计角速率,抑制随机误差,提升陀螺仪使用精度,具体操作步骤包括:Preferably, in step 2, the established random error model is used to transform and obtain the space state equation of the hemispherical resonant gyroscope, and the angular rate is estimated by the set membership filtering algorithm to suppress the random error and improve the use accuracy of the gyroscope. The specific operation steps include:

步骤201:建立空间状态方程Step 201: Establish a space state equation

建立样本数据的时间序列分析模型之后,建立使用状态空间方程描述的线性动态系统,选定系统状态xk,根据模型参数和系统状态xk确定状态转移矩阵Fk、量测矩阵Hk和噪声驱动矩阵Gk,从而建立半球谐振陀螺随机漂移的空间状态方程:After establishing the time series analysis model of the sample data, establish a linear dynamic system described by the state space equation, select the system state x k , and determine the state transition matrix F k , the measurement matrix H k and the noise according to the model parameters and the system state x k Drive the matrix G k to establish the space state equation of the random drift of the hemispherical resonant gyroscope:

xk=Fk-1xk-1+Gk-1wk-1 x k =F k-1 x k-1 +G k-1 w k-1

zk=Hkxk+vk z k =H k x k +v k

将过程噪声wk和量测噪声vk设置为未知但有界,而且属于与噪声等级相适应的椭球集合:Set the process noise w k and measurement noise v k to be unknown but bounded and belong to the set of ellipsoids appropriate to the noise level:

Figure BDA0003275360680000051
Figure BDA0003275360680000051

Figure BDA0003275360680000052
Figure BDA0003275360680000052

其中,Qk、Rk为已知的正定矩阵,为噪声椭球集合的形状描述矩阵;Among them, Q k and R k are known positive definite matrices, which are the shape description matrices of the noise ellipsoid set;

设初始状态属于特定椭球:Let the initial state belong to a specific ellipsoid:

Figure BDA0003275360680000053
Figure BDA0003275360680000053

其中,

Figure BDA0003275360680000054
为椭球的中心,P0为正定矩阵;in,
Figure BDA0003275360680000054
is the center of the ellipsoid, and P 0 is a positive definite matrix;

步骤202:集员滤波过程Step 202: Set membership filtering process

Figure BDA00032753606800000513
为上一时刻估计得到的椭球集;Assume
Figure BDA00032753606800000513
The ellipsoid set estimated for the previous moment;

Figure BDA0003275360680000055
Figure BDA0003275360680000055

其中,

Figure BDA0003275360680000056
为椭球的中心,Pk-1定义了椭球的形状,并满足正定性,σk-1为大于0的标量;in,
Figure BDA0003275360680000056
is the center of the ellipsoid, P k-1 defines the shape of the ellipsoid, and satisfies positive definiteness, σ k-1 is a scalar greater than 0;

通过线性变换

Figure BDA0003275360680000057
之后得到椭球
Figure BDA0003275360680000058
同时过程噪声椭球
Figure BDA0003275360680000059
通过线性变换
Figure BDA00032753606800000510
后转换为
Figure BDA00032753606800000511
而估计目标
Figure BDA00032753606800000512
即为这两个椭球Minkowski和的外定界椭球,其求解过程如下:by linear transformation
Figure BDA0003275360680000057
Then get the ellipsoid
Figure BDA0003275360680000058
Simultaneous Process Noise Ellipsoid
Figure BDA0003275360680000059
by linear transformation
Figure BDA00032753606800000510
converted to
Figure BDA00032753606800000511
while the estimated target
Figure BDA00032753606800000512
It is the outer bounding ellipsoid of the Minkowski sum of the two ellipsoids, and the solution process is as follows:

Figure BDA0003275360680000061
Figure BDA0003275360680000061

σk|k-1=σk-1 σ k|k-1k-1

Figure BDA0003275360680000062
Figure BDA0003275360680000062

其中,pk∈(0,+∞),使用最小迹准则优化参数,得到Among them, p k ∈(0, +∞), using the minimum trace criterion to optimize the parameters, we get

Figure BDA0003275360680000063
Figure BDA0003275360680000063

在量测更新阶段,算法的目标是寻求一个最优椭球

Figure BDA0003275360680000064
使其同时包含量测值和量测噪声确定的集合
Figure BDA0003275360680000065
以及时间更新所得的椭球集合
Figure BDA0003275360680000066
为了提高算法的收敛特性和跟踪能力,采用改进的加权策略来更新椭球集合:In the measurement update phase, the goal of the algorithm is to find an optimal ellipsoid
Figure BDA0003275360680000064
make it contain both the measured value and the set determined by the measurement noise
Figure BDA0003275360680000065
and the collection of ellipsoids resulting from the time update
Figure BDA0003275360680000066
In order to improve the convergence characteristics and tracking ability of the algorithm, an improved weighting strategy is used to update the ellipsoid set:

Figure BDA0003275360680000067
Figure BDA0003275360680000067

其中,zk为量测值,待定参数qk≥0,通过转化,得到

Figure BDA0003275360680000068
的求解过程如下:Among them, z k is the measured value, and the undetermined parameter q k ≥ 0, through transformation, we get
Figure BDA0003275360680000068
The solution process is as follows:

Figure BDA0003275360680000069
Figure BDA0003275360680000069

Figure BDA00032753606800000610
Figure BDA00032753606800000610

Figure BDA00032753606800000611
Figure BDA00032753606800000611

其中,

Figure BDA00032753606800000612
残差
Figure BDA00032753606800000613
in,
Figure BDA00032753606800000612
residual
Figure BDA00032753606800000613

为提高估计边界的稳定性,改进参数优化方法,即通过最小化σk求取最优参数,通过推导,得到参数具体求解过程:In order to improve the stability of the estimated boundary, the parameter optimization method is improved, that is, the optimal parameters are obtained by minimizing σ k , and the specific solution process of the parameters is obtained by derivation:

Figure BDA00032753606800000614
时,其最优值为下式的解:when
Figure BDA00032753606800000614
When , its optimal value is the solution of the following formula:

Figure BDA00032753606800000615
Figure BDA00032753606800000615

Figure BDA00032753606800000616
时,该式无解,此时取0为参数最优值;when
Figure BDA00032753606800000616
When , the formula has no solution, at this time, take 0 as the optimal value of the parameter;

量测更新后的状态椭球包含了对输入角速率的高精度估计,从而实现半球谐振陀螺仪随机误差的抑制和使用性能的提升。The updated state ellipsoid contains a high-precision estimation of the input angular rate, so as to suppress the random error of the hemispherical resonant gyroscope and improve the performance.

本发明的有益效果:Beneficial effects of the present invention:

本发明以集员估计理论为基础,通过采用具有递推性质定界椭球自适应约束最小二乘法进行半球谐振陀螺仪随机误差模型参数的辨识,实现了随机误差信号的在线动态建模。通过优化量测更新的加权策略和参数求解方法,实现了一种改进的集员滤波方法,该方法仅要求噪声有界,而对边界内的噪声具体分布并无要求,也无需知道其统计特性,可以克服传统状态滤波方法的缺陷;通过新的加权策略和优化准则来提高了滤波方法的跟踪和稳定性能;此外,该方法可以获得估计状态的严格不确定边界约束。所以,将所提出的基于集员理论的辨识和滤波方法用于半球谐振陀螺仪随机误差的处理,可以提高抑制随机漂移的精确性和可靠性,从而显著提高其使用精度,且提升效果优于传统滤波方法。Based on the set membership estimation theory, the invention realizes the online dynamic modeling of the random error signal by adopting the recursive bounded ellipsoid adaptive constraint least square method to identify the parameters of the random error model of the hemispherical resonant gyroscope. By optimizing the weighting strategy and parameter solving method of measurement update, an improved set membership filtering method is realized. This method only requires the noise to be bounded, but does not require the specific distribution of the noise in the boundary, and does not need to know its statistical properties. , which can overcome the defects of the traditional state filtering method; the tracking and stability performance of the filtering method are improved by a new weighting strategy and optimization criterion; in addition, the method can obtain the strict uncertainty boundary constraints of the estimated state. Therefore, applying the proposed identification and filtering method based on the set membership theory to the random error processing of the hemispheric resonant gyroscope can improve the accuracy and reliability of suppressing random drift, thereby significantly improving its use accuracy, and the improvement effect is better than traditional filtering methods.

附图说明Description of drawings

为了更清楚地说明本发明实施例或现有技术中的技术方案,下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本发明的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。In order to explain the embodiments of the present invention or the technical solutions in the prior art more clearly, the following briefly introduces the accompanying drawings that need to be used in the description of the embodiments or the prior art. Obviously, the accompanying drawings in the following description are only These are some embodiments of the present invention. For those of ordinary skill in the art, other drawings can also be obtained according to these drawings without creative efforts.

图1所示为本发明的基于集员理论的半球谐振陀螺仪使用性能提升方法的原理框图。FIG. 1 is a schematic block diagram of the performance improvement method of the hemispherical resonant gyroscope based on the set membership theory of the present invention.

图2所示为原始序列样本数据图。Figure 2 shows a graph of the original sequence sample data.

图3所示为预处理后的输出数据时间序列图。Figure 3 shows the time series graph of the output data after preprocessing.

图4所示为半球谐振陀螺仪随机误差模型参数辨识结果图。Figure 4 shows the result of parameter identification of the random error model of the hemispherical resonant gyroscope.

图5所示为半球谐振陀螺仪随机误差滤波结果图。Figure 5 shows the result of random error filtering of the hemispherical resonant gyroscope.

具体实施方式Detailed ways

为使本发明实施例的目的、技术方案和优点更加清楚,下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例是本发明一部分实施例,而不是全部的实施例。通常在此处附图中描述和示出的本发明实施例的组件可以以各种不同的配置来布置和设计。In order to make the purposes, technical solutions and advantages of the embodiments of the present invention clearer, the technical solutions in the embodiments of the present invention will be clearly and completely described below with reference to the accompanying drawings in the embodiments of the present invention. Obviously, the described embodiments These are some embodiments of the present invention, but not all embodiments. The components of the embodiments of the invention generally described and illustrated in the drawings herein may be arranged and designed in a variety of different configurations.

因此,以下对在附图中提供的本发明的实施例的详细描述并非旨在限制要求保护的本发明的范围,而是仅仅表示本发明的选定实施例。基于本发明中的实施例,本领域普通技术人员在没有作出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。Thus, the following detailed description of the embodiments of the invention provided in the accompanying drawings are not intended to limit the scope of the invention as claimed, but are merely representative of selected embodiments of the invention. Based on the embodiments of the present invention, all other embodiments obtained by those of ordinary skill in the art without creative efforts shall fall within the protection scope of the present invention.

本实施例具体提供了一种基于集员理论的半球谐振陀螺仪使用性能提升方法,如图1所示,包括以下步骤:This embodiment specifically provides a method for improving the use performance of a hemispherical resonant gyroscope based on the set membership theory, as shown in FIG. 1 , including the following steps:

步骤1:建立随机误差模型Step 1: Build a random error model

采集半球谐振陀螺静态输出数据,对数据进行预处理之后通过时间序列分析方法建立样本数据的误差模型,并利用集员辨识方法对模型参数进行辨识,得到半球谐振陀螺基于有界噪声假设的随机误差模型,具体包括以下步骤:Collect the static output data of the hemispherical resonant gyroscope, after preprocessing the data, the error model of the sample data is established by the time series analysis method, and the model parameters are identified by the set membership identification method, and the random error of the hemispherical resonant gyroscope based on the assumption of bounded noise is obtained. model, which includes the following steps:

步骤101:数据预处理Step 101: Data Preprocessing

静止状态下采集半球谐振陀螺输出数据后,使用3σ准则进行粗大误差剔除,并采用单位根检验方法对输出数据序列进行平稳性检验;如果检验结果为非平稳序列,则对数据进行差分处理:After collecting the output data of the hemispherical resonant gyroscope in a static state, the 3σ criterion is used to eliminate the gross errors, and the unit root test method is used to test the stationarity of the output data sequence; if the test result is a non-stationary sequence, the data is subjected to differential processing:

y′k=yk+1-yk y′ k =y k+1 -y k

其中,yk为原始输出数据,y′k为差分后的数据,对差分处理后的数据采用单位根检验方法进行平稳性检验,如果检验结果为平稳序列,数据预处理结束;如果结果为非平稳序列,则继续进行差分处理,直至单位根检验结果为平稳序列;Among them, y k is the original output data, y' k is the differenced data, and the unit root test method is used to test the stationarity of the differenced data. If the test result is a stationary sequence, the data preprocessing ends; if the result is not If the sequence is stationary, continue to perform differential processing until the unit root test result is a stationary sequence;

步骤102:确定模型阶次Step 102: Determine the model order

首先对经过预处理的数据序列进行自相关特征和偏相关特征分析确定模型结构,然后利用贝叶斯信息准则来确定阶数;Firstly, the autocorrelation feature and partial correlation feature analysis of the preprocessed data sequence is carried out to determine the model structure, and then the Bayesian information criterion is used to determine the order;

贝叶斯信息准则函数表示为:The Bayesian information criterion function is expressed as:

Figure BDA0003275360680000091
Figure BDA0003275360680000091

式中:N为样本长度;

Figure BDA0003275360680000092
为残差序列;p为模型阶次;则In the formula: N is the sample length;
Figure BDA0003275360680000092
is the residual sequence; p is the model order; then

Figure BDA0003275360680000093
Figure BDA0003275360680000093

通过上式搜索得到BIC最小值,则i为AR部分阶数,减小MA部分阶数,重复该过程,可确定最终模型阶数The minimum value of BIC is obtained through the above search, then i is the order of the AR part, reduce the order of the MA part, and repeat the process to determine the final model order

步骤103:模型参数辨识Step 103: Model parameter identification

根据模型结构和阶数给出具体的模型方程,并将其转换为广义回归模型的形式;通过观测数据得到噪声的边界,并设定模型参数的初值;最后,通过定界椭球自适应约束最小二乘法对模型参数进行动态辨识,得到包含参数可行集的椭球,以椭球中心作为模型的估计参数,建立最终的误差模型;The specific model equation is given according to the model structure and order, and it is converted into the form of a generalized regression model; the noise boundary is obtained through the observation data, and the initial value of the model parameters is set; finally, the adaptive ellipsoid is used to adapt The constrained least squares method is used to dynamically identify the model parameters, and the ellipsoid containing the feasible set of parameters is obtained, and the ellipsoid center is used as the estimated parameter of the model to establish the final error model;

(1)建立随机误差时间序列模型ARMA:(1) Establish a random error time series model ARMA:

Figure BDA0003275360680000094
Figure BDA0003275360680000094

其中,yk陀螺漂移序列,n为AR模型阶数,m为MA模型阶数,ai、bj为待定模型参数,wk为均值为零的可加测量噪声;Among them, y k gyro drift sequence, n is the AR model order, m is the MA model order, a i and b j are undetermined model parameters, and w k is the additive measurement noise with zero mean;

将随机误差时间序列模型转换为广义回归模型:Convert a random error time series model to a generalized regression model:

Figure BDA0003275360680000095
Figure BDA0003275360680000095

其中,Φ为时间序列和噪声矩阵,θ为待定参数向量;若wk是有界的,满足|wk|2<γ2;同时,假设待辨识的参数初值属于椭球:Among them, Φ is the time series and noise matrix, and θ is the parameter vector to be determined; if w k is bounded, it satisfies |w k | 22 ; at the same time, it is assumed that the initial value of the parameter to be identified belongs to an ellipsoid:

Figure BDA0003275360680000101
Figure BDA0003275360680000101

其中,

Figure BDA0003275360680000102
为椭球的中心,M0为正定矩阵,定义了椭球的形状;in,
Figure BDA0003275360680000102
is the center of the ellipsoid, M 0 is a positive definite matrix, which defines the shape of the ellipsoid;

(2)然后利用外包椭球来逼近参数可行集,包含参数可行集的椭球可通过如下过程递推得到(2) Then use the outsourcing ellipsoid to approximate the parameter feasible set, and the ellipsoid containing the parameter feasible set can be obtained recursively through the following process

Figure BDA0003275360680000103
Figure BDA0003275360680000103

Figure BDA0003275360680000108
Figure BDA0003275360680000108

Figure BDA0003275360680000104
Figure BDA0003275360680000104

Figure BDA0003275360680000105
Figure BDA0003275360680000105

其中,

Figure BDA0003275360680000106
Figure BDA0003275360680000107
λk≥0,后续步骤中以参数可行集的椭球中心作为模型参数;in,
Figure BDA0003275360680000106
Figure BDA0003275360680000107
λ k ≥ 0, in the subsequent steps, the ellipsoid center of the parameter feasible set is used as the model parameter;

步骤2:随机误差滤波Step 2: Random Error Filtering

通利建立的随机误差模型,转化得到半球谐振陀螺的空间状态方程,通过集员滤波算法估计角速率,抑制随机误差,提升陀螺仪使用精度,具体操作步骤包括:The random error model established by Tongli is transformed to obtain the space state equation of the hemispherical resonant gyroscope, and the angular rate is estimated by the set membership filtering algorithm to suppress the random error and improve the use accuracy of the gyroscope. The specific operation steps include:

步骤201:建立空间状态方程Step 201: Establish a space state equation

建立样本数据的时间序列分析模型之后,建立使用状态空间方程描述的线性动态系统,选定系统状态xk,根据模型参数和系统状态xk确定状态转移矩阵Fk、量测矩阵Hk和噪声驱动矩阵Gk,从而建立半球谐振陀螺随机漂移的空间状态方程:After establishing the time series analysis model of the sample data, establish a linear dynamic system described by the state space equation, select the system state x k , and determine the state transition matrix F k , the measurement matrix H k and the noise according to the model parameters and the system state x k Drive the matrix G k to establish the space state equation of the random drift of the hemispherical resonant gyroscope:

xk=Fk-1xk-1+Gk-1wk-1 x k =F k-1 x k-1 +G k-1 w k-1

zk=Hkxk+vk z k =H k x k +v k

将过程噪声wk和量测噪声vk设置为未知但有界,而且属于与噪声等级相适应的椭球集合:Set the process noise w k and measurement noise v k to be unknown but bounded and belong to the set of ellipsoids appropriate to the noise level:

Figure BDA0003275360680000111
Figure BDA0003275360680000111

Figure BDA0003275360680000112
Figure BDA0003275360680000112

其中,Qk、Rk为已知的正定矩阵,为噪声椭球集合的形状描述矩阵;Among them, Q k and R k are known positive definite matrices, which are the shape description matrices of the noise ellipsoid set;

设初始状态属于特定椭球:Let the initial state belong to a specific ellipsoid:

Figure BDA0003275360680000113
Figure BDA0003275360680000113

其中,

Figure BDA0003275360680000114
为椭球的中心,P0为正定矩阵;in,
Figure BDA0003275360680000114
is the center of the ellipsoid, and P 0 is a positive definite matrix;

步骤202:集员滤波过程Step 202: Set membership filtering process

Figure BDA0003275360680000115
为上一时刻估计得到的椭球集;Assume
Figure BDA0003275360680000115
The ellipsoid set estimated for the previous moment;

Figure BDA0003275360680000116
Figure BDA0003275360680000116

其中,

Figure BDA0003275360680000117
为椭球的中心,Pk-1定义了椭球的形状,并满足正定性,σk-1为大于0的标量;in,
Figure BDA0003275360680000117
is the center of the ellipsoid, P k-1 defines the shape of the ellipsoid, and satisfies positive definiteness, σ k-1 is a scalar greater than 0;

通过线性变换

Figure BDA0003275360680000118
之后得到椭球
Figure BDA0003275360680000119
同时过程噪声椭球
Figure BDA00032753606800001110
通过线性变换
Figure BDA00032753606800001111
后转换为
Figure BDA00032753606800001112
而估计目标
Figure BDA00032753606800001113
即为这两个椭球Minkowski和的外定界椭球,其求解过程如下:by linear transformation
Figure BDA0003275360680000118
Then get the ellipsoid
Figure BDA0003275360680000119
Simultaneous Process Noise Ellipsoid
Figure BDA00032753606800001110
by linear transformation
Figure BDA00032753606800001111
converted to
Figure BDA00032753606800001112
while the estimated target
Figure BDA00032753606800001113
It is the outer bounding ellipsoid of the Minkowski sum of the two ellipsoids, and the solution process is as follows:

Figure BDA00032753606800001114
Figure BDA00032753606800001114

σk|k-1=σk-1 σ k|k-1k-1

Figure BDA00032753606800001115
Figure BDA00032753606800001115

其中,pk∈(0,+∞),使用最小迹准则优化参数,得到Among them, p k ∈(0, +∞), using the minimum trace criterion to optimize the parameters, we get

Figure BDA00032753606800001116
Figure BDA00032753606800001116

在量测更新阶段,算法的目标是寻求一个最优椭球

Figure BDA00032753606800001117
使其同时包含量测值和量测噪声确定的集合
Figure BDA00032753606800001118
以及时间更新所得的椭球集合
Figure BDA00032753606800001119
为了提高算法的收敛特性和跟踪能力,采用改进的加权策略来更新椭球集合:In the measurement update phase, the goal of the algorithm is to find an optimal ellipsoid
Figure BDA00032753606800001117
make it contain both the measured value and the set determined by the measurement noise
Figure BDA00032753606800001118
and the collection of ellipsoids resulting from the time update
Figure BDA00032753606800001119
In order to improve the convergence characteristics and tracking ability of the algorithm, an improved weighting strategy is used to update the ellipsoid set:

Figure BDA0003275360680000121
Figure BDA0003275360680000121

其中,zk为量测值,待定参数qk≥0,通过转化,得到

Figure BDA0003275360680000122
的求解过程如下:Among them, z k is the measured value, and the undetermined parameter q k ≥ 0, through transformation, we get
Figure BDA0003275360680000122
The solution process is as follows:

Figure BDA0003275360680000123
Figure BDA0003275360680000123

Figure BDA0003275360680000124
Figure BDA0003275360680000124

Figure BDA0003275360680000125
Figure BDA0003275360680000125

其中,

Figure BDA0003275360680000126
残差
Figure BDA0003275360680000127
in,
Figure BDA0003275360680000126
residual
Figure BDA0003275360680000127

为提高估计边界的稳定性,改进参数优化方法,即通过最小化σk求取最优参数,通过推导,得到参数具体求解过程:In order to improve the stability of the estimated boundary, the parameter optimization method is improved, that is, the optimal parameters are obtained by minimizing σ k , and the specific solution process of the parameters is obtained by derivation:

Figure BDA0003275360680000128
时,其最优值为下式的解:when
Figure BDA0003275360680000128
When , its optimal value is the solution of the following formula:

Figure BDA0003275360680000129
Figure BDA0003275360680000129

Figure BDA00032753606800001210
时,该式无解,此时取0为参数最优值;when
Figure BDA00032753606800001210
When , the formula has no solution, at this time, take 0 as the optimal value of the parameter;

量测更新后的状态椭球包含了对输入角速率的高精度估计,从而实现半球谐振陀螺仪随机误差的抑制和使用性能的提升。The updated state ellipsoid contains a high-precision estimation of the input angular rate, so as to suppress the random error of the hemispherical resonant gyroscope and improve the performance.

步骤3:提升效果评估分析Step 3: Evaluation and analysis of improvement effect

通过步骤2得到的估计结果是半球谐振陀螺所敏感的真实角速率的所有可能的集合,集合的形状为椭球,将椭球中心作为点估计结果分析漂移抑制情况,使用估计结果的均方根误差(Root mean square error,RMSE)和Allan方差分析得到的角度随机游走(Angular random walk,ARW)和零偏不稳定性(Bias instability,BI)表征半球谐振陀螺仪漂移大小的指标;使用改善因子描述陀螺仪使用精度提升效果,改善因子定义为:The estimation result obtained in step 2 is all possible sets of the true angular velocity to which the hemispherical resonant gyroscope is sensitive. The shape of the set is an ellipsoid, and the center of the ellipsoid is used as the point estimation result to analyze the drift suppression situation, and the root mean square of the estimation result is used. The Root mean square error (RMSE) and the Angular random walk (ARW) and Bias instability (BI) obtained by Allan variance analysis are used to characterize the drift of the hemispherical resonant gyroscope. The factor describes the accuracy improvement effect of the gyroscope, and the improvement factor is defined as:

Figure BDA00032753606800001211
Figure BDA00032753606800001211

其中,Index1表示抑制后的随机误差指标,Index0表示抑制前的随机误差指标。Among them, Index 1 represents the random error index after suppression, and Index 0 represents the random error index before suppression.

下面以某半球谐振陀螺为例,结合附图对半球谐振陀螺仪长期稳定性的检测方法作进一步说明。Taking a hemispherical resonant gyroscope as an example below, the method for detecting the long-term stability of a hemispherical resonant gyroscope will be further described with reference to the accompanying drawings.

本实施例原理如图1所示。The principle of this embodiment is shown in FIG. 1 .

步骤1:建立随机误差模型Step 1: Build a random error model

根据半球谐振陀螺的输出特性,设定采样间隔为0.4s,采样数为18000,连续采样2小时。试验得到的样本数据如图2所示。According to the output characteristics of the hemispherical resonant gyroscope, the sampling interval is set to 0.4s, the sampling number is 18000, and the continuous sampling is 2 hours. The sample data obtained from the test are shown in Figure 2.

对测试数据进行预处理,经计算可得,样本数据均值为

Figure BDA0003275360680000131
标准差为σ=1.3348e-4,根据3σ准则,其输出稳定范围为
Figure BDA0003275360680000132
超出该稳定范围的值,予以剔除,并以两侧数据的均值代替。然后进行零均值处理和数据转换,得到预处理后的随机误差时间序列如图3所示。The test data is preprocessed, and it can be obtained by calculation. The mean of the sample data is
Figure BDA0003275360680000131
The standard deviation is σ=1.3348e-4, and according to the 3σ criterion, the output stability range is
Figure BDA0003275360680000132
Values outside this stable range are eliminated and replaced by the mean of the data on both sides. Then, zero-mean processing and data transformation are performed to obtain the preprocessed random error time series as shown in Figure 3.

采用单位根检验方法对输出数据序列进行平稳性检验,结果符合平稳性条件。然后对预处理后的随机误差进行自相关特性和偏相关特性进行分析,自相关呈现拖尾性质,偏相关呈现截尾性质,根据时间序列建模理论,采用AR模型进行建模。通过贝叶斯信息准则(Bayesian information criterion,BIC)准则分析,选用AR(3)模型作为半球谐振陀螺随机误差的模型结构。The unit root test method is used to test the stationarity of the output data series, and the results meet the stationarity conditions. Then, the autocorrelation and partial correlation characteristics of the preprocessed random errors are analyzed. The autocorrelation shows the tailing property, and the partial correlation shows the truncation property. According to the time series modeling theory, the AR model is used for modeling. Through the Bayesian information criterion (BIC) criterion analysis, the AR(3) model is selected as the model structure of the random error of the hemispherical resonant gyroscope.

为提高建模精度,将时间序列误差模型作为线性时变系统处理以提高建模精度,且采用实时递推的参数辨识方法,进行数据处理时参数辨识和状态估计同步进行。AR(3)模型模型参数的辨识结果如图4所示。可以看出,辨识方法可以有效跟踪模型参数的变化。In order to improve the modeling accuracy, the time series error model is treated as a linear time-varying system to improve the modeling accuracy, and the real-time recursive parameter identification method is adopted, and the parameter identification and state estimation are carried out simultaneously during data processing. The identification results of the model parameters of the AR(3) model are shown in Figure 4. It can be seen that the identification method can effectively track the changes of the model parameters.

步骤2:随机误差滤波Step 2: Random Error Filtering

得到模型参数的同时,将模型参数代入状态转移矩阵中,建立系统方程,相关的初始参数选取如下:

Figure BDA0003275360680000141
P0=I,Qk=3.0×10-11I,r2=1.52×10-7
Figure BDA0003275360680000142
然后使用发明的集员滤波算法估计系统状态,得到包含真实状态的状态可行集,即包含各时刻真实角速率的椭球集,将椭球集的中心作为真实角速率的估计值,减小随机误差。作为对比,同时也进行基于最小二乘法的时间序列建模和基于卡尔曼滤波的随机误差补偿,作为与本发明随机误差补偿结果的对比。When the model parameters are obtained, the model parameters are substituted into the state transition matrix to establish a system equation. The relevant initial parameters are selected as follows:
Figure BDA0003275360680000141
P 0 =I, Q k =3.0×10 −11 I, r 2 =1.52×10 −7 ,
Figure BDA0003275360680000142
Then use the invented set membership filtering algorithm to estimate the system state, and obtain the state feasible set containing the real state, that is, the ellipsoid set containing the real angular velocity at each moment, and use the center of the ellipsoid set as the estimated value of the real angular velocity to reduce the random error. As a comparison, time series modeling based on the least squares method and random error compensation based on Kalman filtering are also performed as a comparison with the random error compensation results of the present invention.

步骤3:提升效果评估分析Step 3: Evaluation and analysis of improvement effect

将包含真实角速率的椭球集的中心作为角度率的点估计结果,如图5所示。使用其均方根误差和Allan方差分析得到的角度随机游走和零偏不稳定性表征半球谐振陀螺仪漂移大小的指标;使用改善因子描述的随机误差的抑制效果和陀螺仪性能提升效果,具体如表1所示:The center of the ellipsoid set containing the true angular rate is taken as the point estimation result of the angular rate, as shown in Figure 5. Use its root mean square error and Allan variance analysis to obtain the angle random walk and zero bias instability indicators to characterize the drift size of the hemispherical resonant gyroscope; use the improvement factor to describe the random error suppression effect and gyroscope performance improvement effect, specifically As shown in Table 1:

表1性能提升效果Table 1 Performance improvement effect

Figure BDA0003275360680000143
Figure BDA0003275360680000143

由表1可以看出,漂移抑制后的数据在均方根误差、角度随机游走以及零偏不稳定性三个指标上都有了明显的改善,特别是均方根误差降低了一个数量级,证明半球谐振陀螺的随机漂移得到了有效的抑制,其使用性能得到明显提升;且提升效果明显优于卡尔曼滤波结果,特别是RMSE的改善因子相对卡尔曼滤波进一步提高了约56%,证明了本发明的优势。It can be seen from Table 1 that the data after drift suppression has obvious improvements in the three indicators of root mean square error, angle random walk and zero bias instability, especially the root mean square error is reduced by an order of magnitude, It is proved that the random drift of the hemispherical resonant gyroscope has been effectively suppressed, and its performance has been significantly improved; and the improvement effect is obviously better than that of Kalman filtering, especially the improvement factor of RMSE is further improved by about 56% compared with Kalman filtering. Advantages of the present invention.

以上所述,仅用以说明本发明的技术方案而非限制,本领域普通技术人员对本发明的技术方案所做的其它修改或者等同替换,只要不脱离本发明技术方案的精神和范围,均应涵盖在本发明的权利要求范围当中。The above is only used to illustrate the technical solution of the present invention and not to limit it. Other modifications or equivalent replacements made by those of ordinary skill in the art to the technical solution of the present invention, as long as they do not depart from the spirit and scope of the technical solution of the present invention, should be Included within the scope of the claims of the present invention.

Claims (5)

1. A hemispherical resonator gyroscope use performance improving method based on a collective theory is characterized by comprising the following steps:
step 1: establishing a random error model;
step 2: filtering random errors;
and step 3: promotion effect evaluation analysis
The estimation results obtained in the step 2 are all possible sets of the real angular rate to which the hemispherical resonator gyroscope is sensitive, the sets are ellipsoids, the center of each ellipsoid is used as a point estimation result to analyze the drift inhibition condition, and the root mean square error and the zero-bias instability of the estimation results are used for representing the index of the drift size of the hemispherical resonator gyroscope; describing the use precision improvement effect of the gyroscope by using an improvement factor, wherein the improvement factor is defined as:
Figure FDA0003275360670000011
therein, Index1Index representing random error after suppression0Indicating random errors before suppressionAnd (4) a difference index.
2. The method for improving the service performance of the hemispherical resonator gyroscope based on the centralized theory according to claim 1, wherein in the step 1, the method comprises the steps of collecting static output data of the hemispherical resonator gyroscope, preprocessing the data, establishing an error model of sample data by a time series analysis method, and identifying model parameters by using a centralized identification method to obtain a random error model of the hemispherical resonator gyroscope based on a bounded noise hypothesis, and specifically comprises the following steps:
step 101: data pre-processing
After acquiring output data of the hemispherical resonant gyroscope in a static state, performing gross error elimination by using a 3 sigma criterion, and performing stability inspection on an output data sequence by using a unit root inspection method; if the checking result is a non-stationary sequence, carrying out differential processing on the data:
y′k=yk+1-yk
wherein, ykIs the raw output data, y'kFor the data after the difference, carrying out stability test on the data after the difference processing by adopting a unit root test method, and if the test result is a stable sequence, finishing the data preprocessing; if the result is a non-stationary sequence, continuing to perform differential processing until the unit root test result is a stationary sequence;
step 102: determining model order
Firstly, performing autocorrelation characteristic and partial correlation characteristic analysis on a preprocessed data sequence to determine a model structure, and then determining an order by utilizing a Bayesian information criterion;
step 103: model parameter identification
Giving a specific model equation according to the model structure and the order, and converting the specific model equation into a generalized regression model; obtaining the boundary of noise through observation data, and setting the initial value of the model parameter; and finally, carrying out dynamic identification on the model parameters by a bounding ellipsoid adaptive constraint least square method to obtain an ellipsoid containing a feasible set of parameters, and establishing a final error model by taking the center of the ellipsoid as an estimation parameter of the model.
3. The method for improving the performance of the hemispherical resonator gyroscope based on the collective-membership theory as claimed in claim 2, wherein in step 102, the bayesian information criterion function is expressed as:
Figure FDA0003275360670000021
in the formula: n is the sample length;
Figure FDA0003275360670000022
is a residual sequence; p is the model order; then
Figure FDA0003275360670000023
And (4) obtaining the BIC minimum value through the formula search, wherein i is the AR partial order, reducing the MA partial order, and repeating the process to determine the final model order.
4. The method for improving the use performance of the hemispherical resonator gyroscope based on the collective theory as claimed in claim 2, wherein the step 103 comprises the following specific operation steps:
(1) establishing a random error time series model ARMA:
Figure FDA0003275360670000024
wherein, ykA gyro drift sequence, n is the order of AR model, m is the order of MA model, ai、bjFor the parameters of the model to be determined, wkThe noise which can be measured and has a mean value of zero is added;
converting the random error time series model into a generalized regression model:
Figure FDA0003275360670000025
phi is a time sequence and a noise matrix, and theta is a undetermined parameter vector; if wkIs bounded, satisfies | wk|2<γ2
Meanwhile, the initial value of the parameter to be identified is assumed to belong to an ellipsoid:
Figure FDA0003275360670000031
wherein,
Figure FDA0003275360670000032
is the center of an ellipsoid, M0Defining the shape of an ellipsoid for a positive definite matrix;
(2) and then, approximating the parameter feasible set by utilizing the outer-wrapped ellipsoid, wherein the ellipsoid containing the parameter feasible set can be obtained by recursion through the following process
Figure FDA0003275360670000033
Figure FDA0003275360670000034
Figure FDA0003275360670000035
Figure FDA0003275360670000036
Wherein,
Figure FDA0003275360670000037
in the subsequent steps, ginsengThe ellipsoid centers of the feasible sets of numbers serve as model parameters.
5. The method for improving the use performance of the hemispherical resonator gyroscope based on the collective theory as claimed in claim 1, wherein in step 2, the established random error model is used to convert to obtain the space state equation of the hemispherical resonator gyroscope, the collective filtering algorithm is used to estimate the angular rate, suppress the random error and improve the use precision of the gyroscope, and the specific operation steps include:
step 201: establishing a spatial equation of state
After a time series analysis model of sample data is established, a linear dynamic system described by using a state space equation is established, and a system state x is selectedkBased on model parameters and system state xkDetermining a state transition matrix FkA measurement matrix HkSum noise driving matrix GkAnd thus establishing a space state equation of the random drift of the hemispherical resonator gyroscope:
xk=Fk-1xk-1+Gk-1wk-1
zk=Hkxk+vk
process noise wkAnd the measurement noise vkSet to be unknown but bounded and belong to a set of ellipsoids adapted to the noise level:
Figure FDA0003275360670000041
Figure FDA0003275360670000042
wherein Q isk、RkThe known positive definite matrix is a shape description matrix of the noise ellipsoid set;
let the initial state belong to a specific ellipsoid:
Figure FDA0003275360670000043
wherein,
Figure FDA0003275360670000044
is the center of an ellipsoid, P0Is a positive definite matrix;
step 202: collective filtering process
Let εk-1Estimating an ellipsoid set obtained for the last moment;
Figure FDA0003275360670000045
wherein,
Figure FDA0003275360670000046
is the center of an ellipsoid, Pk-1Define the shape of an ellipsoid and satisfy positive qualitative, σk-1A scalar greater than 0;
by linear transformation of Fk-1εk-1Then ellipsoid is obtained
Figure FDA0003275360670000047
Simultaneous process noise ellipsoid
Figure FDA0003275360670000048
By linear transformation
Figure FDA0003275360670000049
After conversion into
Figure FDA00032753606700000410
To estimate a target epsilonk|k-1Namely the outer bounding ellipsoid of the Minkowski sum of the two ellipsoids, the solving process is as follows:
Figure FDA00032753606700000411
σk|k-1=σk-1
Figure FDA00032753606700000412
wherein p iskE (0, infinity), using the minimum trace criterion to optimize the parameters to obtain
Figure FDA00032753606700000413
In the measurement updating stage, the algorithm aims to find an optimal ellipsoid epsilonkSo that it contains both the measured values and the set of measured noise determinations
Figure FDA00032753606700000414
And the ellipsoid set epsilon obtained by time updatingk|k-1In order to improve the convergence property and the tracking capability of the algorithm, an improved weighting strategy is adopted to update the ellipsoid set:
Figure FDA0003275360670000051
wherein z iskFor measured values, the undetermined parameter qkNot less than 0, by conversion to epsilonkThe solution process of (2) is as follows:
Figure FDA0003275360670000052
Figure FDA0003275360670000053
Figure FDA0003275360670000054
wherein,
Figure FDA0003275360670000055
residual error
Figure FDA0003275360670000056
To improve the stability of the estimated boundaries, the parameter optimization method is improved, i.e. by minimizing σkObtaining the optimal parameters, and obtaining a parameter concrete solving process through derivation:
when in use
Figure FDA0003275360670000057
Then, the optimal value is the solution of the following formula:
Figure FDA0003275360670000058
when in use
Figure FDA0003275360670000059
When the formula is not solved, 0 is taken as the optimal value of the parameter;
the state ellipsoid after measurement and update comprises high-precision estimation of the input angular rate, so that the suppression of random errors of the hemispherical resonator gyroscope and the improvement of the use performance are realized.
CN202111116062.5A 2021-09-23 2021-09-23 Hemispherical resonator gyroscope use performance improving method based on collective theory Pending CN113987746A (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202111116062.5A CN113987746A (en) 2021-09-23 2021-09-23 Hemispherical resonator gyroscope use performance improving method based on collective theory

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202111116062.5A CN113987746A (en) 2021-09-23 2021-09-23 Hemispherical resonator gyroscope use performance improving method based on collective theory

Publications (1)

Publication Number Publication Date
CN113987746A true CN113987746A (en) 2022-01-28

Family

ID=79736435

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202111116062.5A Pending CN113987746A (en) 2021-09-23 2021-09-23 Hemispherical resonator gyroscope use performance improving method based on collective theory

Country Status (1)

Country Link
CN (1) CN113987746A (en)

Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN111896029A (en) * 2020-07-29 2020-11-06 西安石油大学 A Random Error Compensation Method of MEMS Gyroscope Based on Combination Algorithm
CN112797967A (en) * 2021-01-31 2021-05-14 南京理工大学 A Graph Optimization-Based Random Drift Error Compensation Method for MEMS Gyroscopes

Patent Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN111896029A (en) * 2020-07-29 2020-11-06 西安石油大学 A Random Error Compensation Method of MEMS Gyroscope Based on Combination Algorithm
CN112797967A (en) * 2021-01-31 2021-05-14 南京理工大学 A Graph Optimization-Based Random Drift Error Compensation Method for MEMS Gyroscopes

Non-Patent Citations (3)

* Cited by examiner, † Cited by third party
Title
杨浩天等: ""基于ARMA-AKF的HRG随机误差建模分析"", 《压电与声光》, vol. 39, no. 1, 28 February 2017 (2017-02-28), pages 101 - 109 *
沈强等: ""未知但有界噪声条件下的MEMS 陀螺信号处理方法"", 《宇航学报》, vol. 38, no. 11, 30 November 2017 (2017-11-30), pages 1219 - 1225 *
沈强等: ""非线性系统中心差分集员估计方法"", 《控制理论与应用》, 31 August 2019 (2019-08-31) *

Similar Documents

Publication Publication Date Title
CN103674062B (en) Based on the method for Allan variance and arma modeling analysis raising gyroscope survey precision
Narasimhappa et al. A modified Sage-Husa adaptive Kalman filter for denoising Fiber Optic Gyroscope signal
WO2016155241A1 (en) Method, system and computer device for capacity prediction based on kalman filter
CN104880172B (en) Method and device for measuring road surface roughness based on Kalman filter
CN110375772B (en) Ring laser random error modeling and compensating method for adaptive Kalman filtering
CN112797967B (en) Random drift error compensation method of MEMS gyroscope based on graph optimization
CN115435768B (en) A temperature modeling and compensation method for hemispherical resonant gyroscope based on real-time sliding window
CN111896029A (en) A Random Error Compensation Method of MEMS Gyroscope Based on Combination Algorithm
CN108413986B (en) A Gyroscope Filtering Method Based on Sage-Husa Kalman Filtering
Li et al. Improved wavelet threshold denoising method for MEMS gyroscope
CN111561930A (en) Method for restraining random drift error of vehicle-mounted MEMS gyroscope
CN116985183B (en) Quality monitoring and management method and system for near infrared spectrum analyzer
CN113820003A (en) Acceleration real-time reconstruction dynamic displacement method suitable for bridge vibration monitoring
CN116861544B (en) A method and related equipment for locating abnormal building vibration sources based on edge-cloud collaboration
CN115790665B (en) Gyro error compensation method and device, electronic equipment and storage medium
CN113901379A (en) A dynamic online fast processing method for real-time data at the edge
CN111339494A (en) Gyroscope data processing method based on Kalman filter
CN113987746A (en) Hemispherical resonator gyroscope use performance improving method based on collective theory
CN106153046B (en) Gyro random noise AR modeling method based on self-adaptive Kalman filtering
CN114088077A (en) An Improved Signal Denoising Method of Hemispherical Resonant Gyroscope
CN114894665B (en) A method and device for detecting slurry concentration, storage medium, and computer equipment
CN115795995A (en) A Resonant Gyro Temperature Compensation Method Based on Stepwise Regression and Gaussian Process
Siraya Statistical interpretation of the Allan variance as a characteristic of measuring and navigation devices
CN112747773B (en) Method for improving precision of gyroscope based on Allan variance and random polynomial
Yan et al. Research on random drift modeling and a kalman filter based on the differential signal of mems gyroscope

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