Gyroscope measurement method and system, storage medium and electronic equipment
Through time series analysis and discrete Kalman filtering technology, error identification and compensation of the noise of MEMS gyroscope is solved, and the measurement accuracy is significantly improved.
Patent Information
- Application Number
- CN202310632791.9
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2023-05-31
- Publication Date
- 2024-12-03
AI Technical Summary
The low accuracy of existing MEMS gyroscopes is mainly due to the large random noise content in the output signal, which leads to insufficient measurement accuracy, and requires effective error identification and noise reduction processing.
Time series analysis method and discrete Kalman filtering method are used to perform noise analysis, stationarity test, error estimation and compensation on the measurement data of the gyroscope, and the influence of random noise is reduced through Allan variation modeling and ARMA model.
It effectively improves the accuracy of the gyroscope's measurement data, reduces errors caused by random noise, and improves the accuracy of the measurement results.
Smart Images

Figure CN119063758A_ABST
Abstract
Description
Background Art
[0002] A gyroscope is a device that is sensitive to angular motion relative to inertial space, meaning "rotational sensitive device". For a long time, the rigid rotor gyroscope was the only choice for inertial navigation systems. Due to the friction torque on its support frame, it has not been able to meet the accuracy requirements. The emergence of liquid-floating gyroscopes has made up for the shortcomings of rotor gyroscopes, but its complex structure and difficulty in manufacturing make it difficult to be widely used. Therefore, in order to meet the special requirements of strapdown systems for gyroscope performance, while continuously improving and developing traditional gyroscopes, we have also vigorously carried out the research and development of optical gyroscopes;
[0003] Micro-electromechanical system gyroscopes have been around for nearly 20 years. Compared with other gyroscopes, MEMS gyroscopes have great advantages in terms of size, cost, power consumption and impact resistance. However, due to the low accuracy in the early days, they have not attracted much attention. In recent years, with the development of microelectronics processing technology, the accuracy of MEMS inertial sensors, especially gyroscopes, has been greatly improved. Inertial navigation systems based on MEMS inertial sensors have become an important research hotspot in the field of inertial technology today. The concept of virtual gyroscopes is proposed to improve the measurement accuracy by studying the correlation of similar sensors. By introducing the idea of morphological filtering into MEMS gyroscope noise reduction, it has certain theoretical research significance, and simulation has achieved certain results.
[0004] However, the current research of many scholars is mostly in the theoretical field, and most of them focus on offline noise reduction of drift. The main reason for the low accuracy of MEMS gyroscopes is the large content of random noise in the output signal. Therefore, it is very necessary to identify and reduce the random error of the gyroscope before use; therefore, we propose a method for identifying and reducing the random error of MEMS gyroscopes. Summary of the invention
[0005] The technical problem to be solved by the present invention is to provide a gyroscope measurement method, system, storage medium and electronic device in view of the deficiencies in the prior art.
[0006] The technical solution of a gyroscope measurement method of the present invention is as follows:
[0007] Perform noise analysis on actual measurement data collected by the gyroscope to obtain analysis results;
[0008] When the analysis result is that the proportion of random noise in the actual measurement data exceeds a threshold, a time series analysis method is used to test the stability of the error caused by the random noise to obtain a stability test result;
[0009] When the stability check result is not stable, error estimation and compensation are performed on the error caused by the random noise to obtain actual measurement data after removing the random noise.
[0010] The beneficial effects of a gyroscope measurement method of the present invention are as follows:
[0011] Error estimation and compensation for the errors caused by random noise can effectively improve the measurement accuracy of the actual measurement data collected by the gyroscope.
[0012] Based on the above solution, a gyroscope measurement method of the present invention can also be improved as follows.
[0013] Furthermore, the actual measurement data collected by the gyroscope is subjected to noise analysis, including:
[0014] Performing Allan variance modeling on the gyroscope to obtain an error model;
[0015] According to the error model, the actual measurement data collected by the gyroscope is analyzed.
[0016] Furthermore, the error model is: in, is: the average angular velocity between the acquisition time of the i-th sampling point and the acquisition time of the i+1-th sampling point, represents the average angular velocity between the acquisition time of the i+1th sampling point and the acquisition time of the i+2th sampling point, represents the error value of the sampling point obtained at time τ, and N represents the number of sampling points.
[0017] Further, error estimation and compensation are performed on the error caused by the random noise, including:
[0018] A discrete Kalman filter equation is established based on the random drift ARMA model to perform error estimation and compensation for the error caused by the random noise.
[0019] The technical solution of a gyroscope measurement system of the present invention is as follows:
[0020] It includes an analysis module, a test module and a compensation module;
[0021] The analysis module is used to: perform noise analysis on the actual measurement data collected by the gyroscope to obtain analysis results;
[0022] The inspection module is used to: when the analysis result is that the proportion of random noise in the actual measurement data exceeds a threshold, use a time series analysis method to inspect the stability of the error caused by the random noise to obtain a stability inspection result;
[0023] The compensation module is used to: when the stability check result is not stable, perform error estimation and compensation on the error caused by the random noise to obtain actual measurement data after removing the random noise.
[0024] The beneficial effects of a gyroscope measurement system of the present invention are as follows:
[0025] Error estimation and compensation for the errors caused by random noise can effectively improve the measurement accuracy of the actual measurement data collected by the gyroscope.
[0026] Based on the above solution, the gyroscope measurement system of the present invention can also be improved as follows.
[0027] Furthermore, the analysis module is specifically used for:
[0028] Performing Allan variance modeling on the gyroscope to obtain an error model;
[0029] According to the error model, the actual measurement data collected by the gyroscope is analyzed.
[0030] Furthermore, the error model is: in, is: the average angular velocity between the acquisition time of the i-th sampling point and the acquisition time of the i+1-th sampling point, represents the average angular velocity between the acquisition time of the i+1th sampling point and the acquisition time of the i+2th sampling point, represents the error value of the sampling point obtained at time τ, and N represents the number of sampling points.
[0031] Furthermore, the compensation module is specifically used for:
[0032] A discrete Kalman filter equation is established based on the random drift ARMA model to perform error estimation and compensation for the error caused by the random noise.
[0033] A storage medium of the present invention stores instructions, and when a computer reads the instructions, the computer executes any one of the gyroscope measurement methods described above.
[0034] An electronic device of the present invention comprises a processor and the above-mentioned storage medium, wherein the processor executes instructions in the storage medium. BRIEF DESCRIPTION OF THE DRAWINGS
[0035] Figure 1 A schematic flow chart of a gyroscope measurement method according to an embodiment of the present invention;
[0036] Figure 2The figure is a schematic structural diagram of a gyroscope measurement system according to an embodiment of the present invention. DETAILED DESCRIPTION
[0037] like Figure 1 As shown, a gyroscope measurement method according to an embodiment of the present invention comprises the following steps:
[0038] S1. Performing noise analysis on actual measurement data collected by the gyroscope to obtain analysis results;
[0039] S2. When the analysis result is that the proportion of random noise in the actual measurement data exceeds the threshold, the time series analysis method is used to test the stability of the error caused by the random noise to obtain the stability test result;
[0040] Among them, the time series analysis method is used to test the stationarity of the random noise of the MEMS gyroscope. For a set of discrete random data sequences, the statistical characteristics in the time domain and frequency domain are analyzed to obtain the statistical characteristics of the actual physical system, and the random data are condensed into a simple random difference model.
[0041] S3. When the result of the stability check is not stable, the error caused by the random noise is estimated and compensated to obtain the actual measurement data after removing the random noise.
[0042] The present invention carries out error estimation and compensation for the error caused by random noise, which can effectively improve the measurement accuracy of actual measurement data collected by the gyroscope.
[0043] Optionally, in the above technical solution, in S1, performing noise analysis on actual measurement data collected by the gyroscope includes:
[0044] S10, perform Allan variance modeling on the gyroscope to obtain an error model;
[0045] S11. Analyze the actual measurement data collected by the gyroscope according to the error model.
[0046] Optionally, in the above technical solution, the error model is: in, is: the average angular velocity between the acquisition time of the i-th sampling point and the acquisition time of the i+1-th sampling point, represents the average angular velocity between the acquisition time of the i+1th sampling point and the acquisition time of the i+2th sampling point, represents the error value of the sampling point obtained at time τ, and N represents the number of sampling points.
[0047] Optionally, in the above technical solution, in S3, error estimation and compensation for the error caused by random noise include:
[0048] S30. A discrete Kalman filter equation is established based on the random drift ARMA model to perform error estimation and compensation for the error caused by random noise.
[0049] Among them, the stationary random process described by the ARMA model is expressed as
[0050] Where p and q are the orders of the model’s autoregressive term and moving average term, is the deviation of the observed value at time t relative to the mean, and θ j are model parameters, a(t) has a mean of 0 and a variance of This model can be used to predict the random drift sequence, and then the corresponding Kalman filter can be designed to effectively reduce the random drift and improve the measurement accuracy.
[0051] The discrete Kalman filter equation uses the minimum mean square error as the optimal estimation criterion. It adopts the state space model of signal and noise to update the estimate of state variables using the estimated value at the previous moment and the observed value at the current moment, and calculates the estimated value at the current moment. The algorithm makes an estimate of the signal to be processed that satisfies the minimum mean square error based on the established system equation and observation equation.
[0052] The basic algorithm of discrete Kalman filtering has two recursive sub-processes, the gain calculation process and the filter calculation process. The gain calculation subsystem can run independently, and the filter calculation subsystem is built on the basis of the gain calculation subsystem. Kalman filtering is periodic and uses system information and measurement information to realize two information update processes, the estimated state quantity that is continuously updated with time and the measurement process that is continuously updated with the update of the state transfer matrix, driving noise matrix, and variance matrix.
[0053] In this scheme, the identification and compensation of random errors are carried out in the following steps:
[0054] ① Test the normality and stability of the signal;
[0055] The normality of the signal can be determined by calculating the skewness and steepness of the signal, that is, the third-order moment and the fourth-order moment. If the third-order moment is close to Q and the fourth-order moment is close to 3, the signal is considered normal. The third-order moment of the three-axis gyroscope is calculated to be -0.053 2-0 130 0 and -0.096 6, and the fourth-order is 3.0166, 2912 8 and 2 931 8, respectively, which meets the normality condition. The run method is used to verify that the signal also meets the stationarity condition.
[0056] ②Model determination;
[0057] The difference between AR and MA models can be reflected in the characteristics of their autocorrelation functions and partial correlation functions. The type of model can be determined by analyzing the autocorrelation function and partial correlation function of the sample sequence. The autocorrelation function of the gyro signal changes slowly and has a long-term correlation, that is, the autocorrelation function has a "tail", while its partial correlation function changes rapidly and has a "truncation" characteristic; therefore, the model of the gyro drift signal can be described by the AR model.
[0058] ③Determination of model order;
[0059] In order to determine the order of the model, we also need to use the PPE criterion or the AIC criterion to find the model that minimizes the PPE criterion or the AC criterion and determine the most suitable model and order.
[0060] In this scheme, Kalman assumes that the actual system will be affected by white noise with a Gaussian distribution of mean 0, and the sensor will also be affected by Gaussian white noise with a mean of 0. The algorithm first predicts the state at a certain moment, and then updates it using the sensor observation value. The update method involves noise and MSE theory.
[0061] In the above embodiments, although the steps are numbered S1, S2, etc., these are only specific embodiments given in the present application. Those skilled in the art may adjust the execution order of S1, S2, etc. according to actual conditions, which is also within the scope of protection of the present invention. It can be understood that in some embodiments, some or all of the above embodiments may be included.
[0062] like Figure 2 As shown, a gyroscope measurement system 200 according to an embodiment of the present invention includes an analysis module 210, a verification module 220 and a compensation module 230;
[0063] The analysis module 210 is used to: perform noise analysis on the actual measurement data collected by the gyroscope to obtain analysis results;
[0064] The inspection module 220 is used to: when the analysis result is that the proportion of random noise in the actual measurement data exceeds a threshold, use a time series analysis method to inspect the stability of the error caused by the random noise to obtain a stability inspection result;
[0065] The compensation module 230 is used to: when the stability check result is not stable, perform error estimation and compensation on the error caused by random noise to obtain actual measurement data after removing the random noise.
[0066] Optionally, in the above technical solution, the analysis module 210 is specifically used for:
[0067] Perform Allan variance modeling on the gyroscope to obtain the error model;
[0068] According to the error model, the actual measurement data collected by the gyroscope is analyzed.
[0069] Optionally, in the above technical solution, the error model is: in, is: the average angular velocity between the acquisition time of the i-th sampling point and the acquisition time of the i+1-th sampling point, represents the average angular velocity between the acquisition time of the i+1th sampling point and the acquisition time of the i+2th sampling point, represents the error value of the sampling point obtained at time τ, and N represents the number of sampling points.
[0070] Optionally, in the above technical solution, the compensation module 230 is specifically used for:
[0071] A discrete Kalman filter equation is established based on the random drift ARMA model to carry out error estimation and compensation for the error caused by random noise.
[0072] The above parameters and steps for each unit module to implement corresponding functions in a gyroscope measurement system 200 of the present invention can refer to the parameters and steps in the embodiment of a gyroscope measurement method above, and will not be described in detail here.
[0073] A storage medium according to an embodiment of the present invention stores instructions, and when a computer reads the instructions, the computer executes any one of the above gyroscope measurement methods.
[0074] An electronic device according to an embodiment of the present invention comprises a processor and the above-mentioned storage medium, wherein the processor executes instructions in the storage medium. The electronic device may be a computer, a mobile phone, or the like.
[0075] Those skilled in the art will appreciate that the present invention may be implemented as a system, method or computer program product.
[0076] Therefore, the present disclosure may be specifically implemented in the following forms, namely: it may be completely hardware, it may be completely software (including firmware, resident software, microcode, etc.), or it may be a combination of hardware and software, generally referred to herein as a "circuit", "module" or "system". In addition, in some embodiments, the present invention may also be implemented in the form of a computer program product in one or more computer-readable media, and the computer-readable medium contains computer-readable program code.
[0077] Any combination of one or more computer-readable media can be used. Computer-readable media can be computer-readable signal media or computer-readable storage media. Computer-readable storage media can be, for example, but not limited to, electrical, magnetic, optical, electromagnetic, infrared, or semiconductor systems, devices or devices, or any combination of the above. More specific examples (non-exhaustive list) of computer-readable storage media include: electrical connections with one or more wires, portable computer disks, hard disks, random access memories (RAM), read-only memories (ROM), erasable programmable read-only memories (EPROM or flash memory), optical fibers, portable compact disk read-only memories (CD-ROM), optical storage devices, magnetic storage devices, or any suitable combination of the above. In this document, computer-readable storage media can be any tangible medium containing or storing a program, which can be used by an instruction execution system, device or device or used in combination with it.
[0078] Although the embodiments of the present invention have been shown and described above, it is to be understood that the above embodiments are exemplary and are not to be construed as limitations of the present invention. A person skilled in the art may change, modify, replace and vary the above embodiments within the scope of the present invention.
Claims
1. A gyroscope measurement method, characterized in that: include: Perform noise analysis on actual measurement data collected by the gyroscope to obtain analysis results; When the analysis result is that the proportion of random noise in the actual measurement data exceeds a threshold, a time series analysis method is used to test the stability of the error caused by the random noise to obtain a stability test result; When the stability check result is not stable, error estimation and compensation are performed on the error caused by the random noise to obtain actual measurement data after removing the random noise.
2. A gyroscope measurement method according to claim 1, characterized in that: Perform noise analysis on the actual measurement data collected by the gyroscope, including: Performing Allan variance modeling on the gyroscope to obtain an error model; According to the error model, the actual measurement data collected by the gyroscope is analyzed.
3. A gyroscope measurement method according to claim 2, characterized in that: The error model is: in, is: the average angular velocity between the acquisition time of the i-th sampling point and the acquisition time of the i+1-th sampling point, represents the average angular velocity between the acquisition time of the i+1th sampling point and the acquisition time of the i+2th sampling point, represents the error value of the sampling point obtained at time τ, and N represents the number of sampling points.
4. A gyroscope measurement method according to any one of claims 1 to 3, characterized in that: The error caused by the random noise is estimated and compensated, including: A discrete Kalman filter equation is established based on the random drift ARMA model to perform error estimation and compensation for the error caused by the random noise.
5. A gyroscope measurement system, characterized in that: It includes an analysis module, a test module and a compensation module; The analysis module is used to: perform noise analysis on the actual measurement data collected by the gyroscope to obtain analysis results; The inspection module is used to: when the analysis result is that the proportion of random noise in the actual measurement data exceeds a threshold, use a time series analysis method to inspect the stability of the error caused by the random noise to obtain a stability inspection result; The compensation module is used to: when the stability check result is not stable, perform error estimation and compensation on the error caused by the random noise to obtain actual measurement data after removing the random noise.
6. A gyroscope measurement system according to claim 5, characterized in that: The analysis module is specifically used for: Performing Allan variance modeling on the gyroscope to obtain an error model; According to the error model, the actual measurement data collected by the gyroscope is analyzed.
7. A gyroscope measurement system according to claim 6, characterized in that: The error model is: in, is: the average angular velocity between the acquisition time of the i-th sampling point and the acquisition time of the i+1-th sampling point, represents the average angular velocity between the acquisition time of the i+1th sampling point and the acquisition time of the i+2th sampling point, represents the error value of the sampling point obtained at time τ, and N represents the number of sampling points.
8. A gyroscope measurement system according to any one of claims 5 to 7, characterized in that: The compensation module is used for: A discrete Kalman filter equation is established based on the random drift ARMA model to perform error estimation and compensation for the error caused by the random noise.
9. A storage medium, characterized in that: The storage medium stores instructions, and when a computer reads the instructions, the computer executes a gyroscope measurement method according to any one of claims 1 to 4.
10. An electronic device, characterized in that: The invention comprises a processor and the storage medium as claimed in claim 9, wherein the processor executes instructions in the storage medium.
