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 PDFInfo
- 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
Links
- 238000000034 method Methods 0.000 title claims abstract description 82
- 238000001914 filtration Methods 0.000 claims abstract description 27
- 230000000694 effects Effects 0.000 claims abstract description 13
- 238000012360 testing method Methods 0.000 claims abstract description 13
- 238000004422 calculation algorithm Methods 0.000 claims abstract description 11
- 230000001629 suppression Effects 0.000 claims abstract description 11
- 230000003068 static effect Effects 0.000 claims abstract description 7
- 230000008569 process Effects 0.000 claims description 24
- 239000011159 matrix material Substances 0.000 claims description 21
- 230000006872 improvement Effects 0.000 claims description 19
- 238000005259 measurement Methods 0.000 claims description 15
- 238000004458 analytical method Methods 0.000 claims description 12
- 238000012545 processing Methods 0.000 claims description 11
- 238000007781 pre-processing Methods 0.000 claims description 9
- 238000001744 unit root test Methods 0.000 claims description 9
- 230000009466 transformation Effects 0.000 claims description 7
- 238000012731 temporal analysis Methods 0.000 claims description 6
- 238000000700 time series analysis Methods 0.000 claims description 6
- 230000003044 adaptive effect Effects 0.000 claims description 4
- 238000011156 evaluation Methods 0.000 claims description 4
- 238000005457 optimization Methods 0.000 claims description 4
- 230000007704 transition Effects 0.000 claims description 4
- 241001123248 Arma Species 0.000 claims description 3
- 238000009795 derivation Methods 0.000 claims description 3
- 238000006243 chemical reaction Methods 0.000 claims 2
- 238000007689 inspection Methods 0.000 claims 2
- 230000008030 elimination Effects 0.000 claims 1
- 238000003379 elimination reaction Methods 0.000 claims 1
- 230000005764 inhibitory process Effects 0.000 claims 1
- 238000013112 stability test Methods 0.000 claims 1
- 230000002401 inhibitory effect Effects 0.000 abstract 1
- 229910010413 TiO 2 Inorganic materials 0.000 description 3
- 238000009826 distribution Methods 0.000 description 3
- 239000000463 material Substances 0.000 description 3
- 238000005295 random walk Methods 0.000 description 3
- 238000005070 sampling Methods 0.000 description 3
- 239000000654 additive Substances 0.000 description 2
- 230000000996 additive effect Effects 0.000 description 2
- 230000007547 defect Effects 0.000 description 2
- 230000007774 longterm Effects 0.000 description 2
- 238000012946 outsourcing Methods 0.000 description 2
- 238000011160 research Methods 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000004364 calculation method Methods 0.000 description 1
- 230000000739 chaotic effect Effects 0.000 description 1
- 238000013501 data transformation Methods 0.000 description 1
- 238000001514 detection method Methods 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 238000013485 heteroscedasticity test Methods 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000003672 processing method Methods 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F30/00—Computer-aided design [CAD]
- G06F30/20—Design optimisation, verification or simulation
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F17/00—Digital computing or data processing equipment or methods, specially adapted for specific functions
- G06F17/10—Complex mathematical operations
- G06F17/11—Complex mathematical operations for solving equations, e.g. nonlinear equations, general mathematical optimization problems
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F17/00—Digital computing or data processing equipment or methods, specially adapted for specific functions
- G06F17/10—Complex mathematical operations
- G06F17/16—Matrix or vector computation, e.g. matrix-matrix or matrix-vector multiplication, matrix factorization
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F2119/00—Details relating to the type or aim of the analysis or the optimisation
- G06F2119/10—Noise 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
Description
技术领域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:
其中,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
步骤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:
式中:N为样本长度;为残差序列;p为模型阶次;则In the formula: N is the sample length; is the residual sequence; p is the model order; then
通过上式搜索得到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:
其中,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:
其中,Φ为时间序列和噪声矩阵,θ为待定参数向量;若wk是有界的,满足|wk|2<γ2;Among them, Φ is the time series and noise matrix, θ is the undetermined parameter vector; if w k is bounded, it satisfies |w k | 2 <γ 2 ;
同时,假设待辨识的参数初值属于椭球:At the same time, it is assumed that the initial value of the parameter to be identified belongs to an ellipsoid:
其中,为椭球的中心,M0为正定矩阵,定义了椭球的形状;in, 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
其中, λk≥0,后续步骤中以参数可行集的椭球中心作为模型参数。in, λ 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:
其中,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:
其中,为椭球的中心,P0为正定矩阵;in, is the center of the ellipsoid, and P 0 is a positive definite matrix;
步骤202:集员滤波过程Step 202: Set membership filtering process
设为上一时刻估计得到的椭球集;Assume The ellipsoid set estimated for the previous moment;
其中,为椭球的中心,Pk-1定义了椭球的形状,并满足正定性,σk-1为大于0的标量;in, 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;
通过线性变换之后得到椭球同时过程噪声椭球通过线性变换后转换为而估计目标即为这两个椭球Minkowski和的外定界椭球,其求解过程如下:by linear transformation Then get the ellipsoid Simultaneous Process Noise Ellipsoid by linear transformation converted to while the estimated target It is the outer bounding ellipsoid of the Minkowski sum of the two ellipsoids, and the solution process is as follows:
σk|k-1=σk-1 σ k|k-1 =σ k-1
其中,pk∈(0,+∞),使用最小迹准则优化参数,得到Among them, p k ∈(0, +∞), using the minimum trace criterion to optimize the parameters, we get
在量测更新阶段,算法的目标是寻求一个最优椭球使其同时包含量测值和量测噪声确定的集合以及时间更新所得的椭球集合为了提高算法的收敛特性和跟踪能力,采用改进的加权策略来更新椭球集合:In the measurement update phase, the goal of the algorithm is to find an optimal ellipsoid make it contain both the measured value and the set determined by the measurement noise and the collection of ellipsoids resulting from the time update In order to improve the convergence characteristics and tracking ability of the algorithm, an improved weighting strategy is used to update the ellipsoid set:
其中,zk为量测值,待定参数qk≥0,通过转化,得到的求解过程如下:Among them, z k is the measured value, and the undetermined parameter q k ≥ 0, through transformation, we get The solution process is as follows:
其中,残差 in, residual
为提高估计边界的稳定性,改进参数优化方法,即通过最小化σ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:
当时,其最优值为下式的解:when When , its optimal value is the solution of the following formula:
当时,该式无解,此时取0为参数最优值;when 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:
式中:N为样本长度;为残差序列;p为模型阶次;则In the formula: N is the sample length; is the residual sequence; p is the model order; then
通过上式搜索得到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:
其中,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:
其中,Φ为时间序列和噪声矩阵,θ为待定参数向量;若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 | 2 <γ 2 ; at the same time, it is assumed that the initial value of the parameter to be identified belongs to an ellipsoid:
其中,为椭球的中心,M0为正定矩阵,定义了椭球的形状;in, 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
其中, λk≥0,后续步骤中以参数可行集的椭球中心作为模型参数;in, λ 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:
其中,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:
其中,为椭球的中心,P0为正定矩阵;in, is the center of the ellipsoid, and P 0 is a positive definite matrix;
步骤202:集员滤波过程Step 202: Set membership filtering process
设为上一时刻估计得到的椭球集;Assume The ellipsoid set estimated for the previous moment;
其中,为椭球的中心,Pk-1定义了椭球的形状,并满足正定性,σk-1为大于0的标量;in, 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;
通过线性变换之后得到椭球同时过程噪声椭球通过线性变换后转换为而估计目标即为这两个椭球Minkowski和的外定界椭球,其求解过程如下:by linear transformation Then get the ellipsoid Simultaneous Process Noise Ellipsoid by linear transformation converted to while the estimated target It is the outer bounding ellipsoid of the Minkowski sum of the two ellipsoids, and the solution process is as follows:
σk|k-1=σk-1 σ k|k-1 =σ k-1
其中,pk∈(0,+∞),使用最小迹准则优化参数,得到Among them, p k ∈(0, +∞), using the minimum trace criterion to optimize the parameters, we get
在量测更新阶段,算法的目标是寻求一个最优椭球使其同时包含量测值和量测噪声确定的集合以及时间更新所得的椭球集合为了提高算法的收敛特性和跟踪能力,采用改进的加权策略来更新椭球集合:In the measurement update phase, the goal of the algorithm is to find an optimal ellipsoid make it contain both the measured value and the set determined by the measurement noise and the collection of ellipsoids resulting from the time update In order to improve the convergence characteristics and tracking ability of the algorithm, an improved weighting strategy is used to update the ellipsoid set:
其中,zk为量测值,待定参数qk≥0,通过转化,得到的求解过程如下:Among them, z k is the measured value, and the undetermined parameter q k ≥ 0, through transformation, we get The solution process is as follows:
其中,残差 in, residual
为提高估计边界的稳定性,改进参数优化方法,即通过最小化σ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:
当时,其最优值为下式的解:when When , its optimal value is the solution of the following formula:
当时,该式无解,此时取0为参数最优值;when 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:
其中,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.
对测试数据进行预处理,经计算可得,样本数据均值为标准差为σ=1.3348e-4,根据3σ准则,其输出稳定范围为超出该稳定范围的值,予以剔除,并以两侧数据的均值代替。然后进行零均值处理和数据转换,得到预处理后的随机误差时间序列如图3所示。The test data is preprocessed, and it can be obtained by calculation. The mean of the sample data is The standard deviation is σ=1.3348e-4, and according to the 3σ criterion, the output stability range is 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
得到模型参数的同时,将模型参数代入状态转移矩阵中,建立系统方程,相关的初始参数选取如下:P0=I,Qk=3.0×10-11I,r2=1.52×10-7,然后使用发明的集员滤波算法估计系统状态,得到包含真实状态的状态可行集,即包含各时刻真实角速率的椭球集,将椭球集的中心作为真实角速率的估计值,减小随机误差。作为对比,同时也进行基于最小二乘法的时间序列建模和基于卡尔曼滤波的随机误差补偿,作为与本发明随机误差补偿结果的对比。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: P 0 =I, Q k =3.0×10 −11 I, r 2 =1.52×10 −7 , 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
由表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)
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)
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 |
-
2021
- 2021-09-23 CN CN202111116062.5A patent/CN113987746A/en active Pending
Patent Citations (2)
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)
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 |