CN114543843B - Method for calibrating and correcting channel error of resonant gyroscope - Google Patents

Method for calibrating and correcting channel error of resonant gyroscope Download PDF

Info

Publication number
CN114543843B
CN114543843B CN202210246190.XA CN202210246190A CN114543843B CN 114543843 B CN114543843 B CN 114543843B CN 202210246190 A CN202210246190 A CN 202210246190A CN 114543843 B CN114543843 B CN 114543843B
Authority
CN
China
Prior art keywords
error
standing wave
angle
channel error
azimuth angle
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.)
Active
Application number
CN202210246190.XA
Other languages
Chinese (zh)
Other versions
CN114543843A (en
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.)
707th Research Institute of CSIC
Original Assignee
707th Research Institute of CSIC
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 707th Research Institute of CSIC filed Critical 707th Research Institute of CSIC
Priority to CN202210246190.XA priority Critical patent/CN114543843B/en
Publication of CN114543843A publication Critical patent/CN114543843A/en
Application granted granted Critical
Publication of CN114543843B publication Critical patent/CN114543843B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C25/00Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass
    • G01C25/005Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass initial alignment, calibration or starting-up of inertial devices
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C19/00Gyroscopes; Turn-sensitive devices using vibrating masses; Turn-sensitive devices without moving masses; Measuring angular rate using gyroscopic effects
    • G01C19/56Turn-sensitive devices using vibrating masses, e.g. vibratory angular rate sensors based on Coriolis forces

Landscapes

  • Engineering & Computer Science (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Manufacturing & Machinery (AREA)
  • Gyroscopes (AREA)

Abstract

The invention relates to a resonant gyroscope channel error calibration methodThe correction method comprises the following steps: 1. establishing a channel error identification model, and placing the model in a control system of a resonant gyroscope; 2. determining the number n of error parameters to be identified, and calling an identification model; 3. initializing a standing wave azimuth angle theta, and placing the standing wave azimuth angle theta at a random initial position theta 0 The method comprises the steps of carrying out a first treatment on the surface of the 4. Moving θ to be positioned at θ i =θ 0 +ipi/2 n; 5. calculate each θ i Additional drift angle at
Figure DDA0004133753020000011
6. Identifying and calculating n error parameters; 7. substituting the error parameters into an error model, and correcting the current loop coefficient; 8. determining calculation residual error e of each parameter k Whether or not the set termination condition e is satisfied k <e set Counting the number k of parameters subjected to correction; 9. updating the number n of parameters to be identified and a channel error identification model; 10. if the parameter n to be identified is not zero, updating the random initial standing wave azimuth angle theta 0 =θ 0 +r, return to step 2. Otherwise, the iteration is stopped. The method improves zero offset and resolution performance of the gyroscope and improves scale factor nonlinearity.

Description

Method for calibrating and correcting channel error of resonant gyroscope
Technical Field
The invention belongs to the technical field of inertial instrument control, and particularly relates to a method for calibrating and correcting channel errors of a resonant gyroscope.
Background
Compared with the traditional force feedback mode, the full angle mode resonant gyroscope has the outstanding advantages of wide range, high dynamic performance, stable calibration factor and the like. The stable control and the angle reading of the standing wave are realized by driving and detecting the vibration mode of the harmonic oscillator through the fixed electrode. As an angle sensor, the standing wave azimuth angle is directly sensitive to external angle change, so that the angle sensor can be positioned at any position of the annular harmonic oscillator. In practical application, due to the consistency of processing and manufacturing and devices, additional measurement errors are overlapped and coupled with a harmonic oscillator dynamics model, and the performance index of the gyroscope is seriously affected.
Besides frequency splitting and damping non-uniformity caused by defects of a harmonic oscillator body, errors caused by inconsistent electrodes and circuits can be uniformly equivalent to inconsistent errors of gains, positions and phase shifts of the electrodes. The electrodes are classified into driving channel errors and detecting channel errors according to their application to driving or detection. The presence of these errors introduces, on the one hand, an additional zero offset drift in the gyro output; on the other hand, the measurement accuracy of the standing wave angle is disturbed, and the error is superimposed on the mapping coefficient of the standing wave angle and the external angle, namely the Blaine coefficient, so that the periodic characteristic along with the standing wave position is shown.
To achieve good gyroscopic performance, channel errors need to be corrected. In the traditional mode, a single index such as zero offset, scale factors and the like is compensated and corrected in an experimental data fitting mode. However, because the channel error parameters are more and are coupled with the harmonic oscillator errors, nonlinearity is generated, and a good correction effect is difficult to achieve in a later stage fitting compensation mode.
Disclosure of Invention
Aiming at the defects of the prior art, the invention provides a method for calibrating and correcting the channel error of a resonant gyroscope, which can improve zero offset and resolution performance of the gyroscope, reduce the error of a scale factor and improve the nonlinearity of the scale factor.
The above object of the present invention is achieved by the following technical solutions:
a method for calibrating and correcting channel errors of a resonant gyroscope is characterized by comprising the following steps of: the method comprises the following steps:
step 1, establishing a channel error identification model, and placing the established model in a control system of a resonant gyroscope;
step 2, determining the number n of error parameters to be identified according to task requirements, and calling a channel error identification model;
step 3, initializing a standing wave azimuth angle theta and placing the standing wave azimuth angle theta at a random initial position theta 0
Step 4, moving the standing wave azimuth angle theta to be positioned at the theta i =θ 0 +iπ/2n,i=1,…,n;
Step 5, calculating the angle extra drift amount at each standing wave azimuth angle thetai in the process of moving the standing wave azimuth angle thetai n times in the step 4;
step 6, according to the additional drift angle
Figure GDA0004133753010000011
The channel error identification model is used for identifying and calculating n error parameters;
step 7, substituting the calculated error parameters into the corresponding positions of the error model to correct the current loop coefficient;
step 8, judging the calculation residual error e of each parameter k Whether or not the set termination condition e is satisfied k <e set Counting the number k of parameters subjected to correction;
step 9, updating the number n of parameters to be identified and a channel error identification model;
step 10, if the parameter n to be identified is not zero, updating the random initial standing wave azimuth angle θ 0 =θ 0 +r, returning to step 2; otherwise, the iteration is stopped.
Further: the channel errors involved in step 1 include a detection channel error a and a drive channel error B;
detecting channel error A includes electrode gain offset Δk d Electrode position deviation delta theta d Electrode phase shift deviation delta phi d For the detection channel error A, the standing wave angle is calculated
Figure GDA0004133753010000021
Real angle with standing wave->
Figure GDA0004133753010000022
There is an error related to the standing wave azimuth angle θ as shown in equation (1).
Figure GDA0004133753010000023
Wherein-a is the antinode amplitude;
b is the node amplitude;
——
Figure GDA0004133753010000024
calculating a standing wave angle;
——Δk d to detect electrode gain deviation;
——Δθ d to detect electrode position deviations;
——Δφ d to detect the electrode phase shift deviation;
the driving channel error B includes the electrode gain deviation Deltak e Deviation of electrode position
Figure GDA0004133753010000025
And->
Figure GDA0004133753010000026
Electrode phase shift deviation delta phi e The method comprises the steps of carrying out a first treatment on the surface of the For the drive channel error B, it is mainly manifested as cross-coupling of the control signals, thereby causing additional drift Δε at each standing wave azimuth angle θ e An error equation of the driving error B to the standing wave azimuth angle theta is established as shown in a formula (2):
Figure GDA0004133753010000027
in-Deltak e Driving the electrode gain bias for X;
——
Figure GDA0004133753010000028
x, Y drive electrode position deviations;
——Δφ e phase shift deviation for Y driving electrode;
——Δε e introducing additional drift for drive error;
SF is the electrode force application scale factor;
——
Figure GDA0004133753010000031
inducing a standing wave azimuth drift angle for the driving error;
——C a is a stable control signal;
——C q is a quadrature control signal;
the real angle of the standing wave is detected by the existence of the channel error A
Figure GDA0004133753010000032
Unknown, the standing wave angle θ in the driving error equation (2) is rewritten as an angle calculation value +.>
Figure GDA0004133753010000033
Obtaining a channel error identification model as shown in (3)
Figure GDA0004133753010000034
Further: in step 4, the rotation of the standing wave can be provided by the external carrier rotation speed omega, or by applying the active precession signal C p Providing.
Further: in step 5, an additional drift angle is calculated when the rotation is provided using the external carrier
Figure GDA0004133753010000035
The formula is as follows:
Figure GDA0004133753010000036
middle- (2)
Figure GDA0004133753010000037
Is an additional drift angle;
——
Figure GDA0004133753010000038
is the azimuth angle theta of the standing wave i Calculating the azimuth angle theta of the standing wave at the position;
-alpha is the Blaine coefficient truth value;
omega is the rotation speed of the external carrier;
t is the rotation time.
Further: the method for obtaining the real value of the Blaine coefficient comprises the following steps:
since the detection channel error matrix A has various anisotropic characteristics, the Coriolis force term in the harmonic oscillator dynamics equation generates additional errors, an equivalent Blaine coefficient is introduced, and the relation between the equivalent Blaine coefficient alpha' (theta) and the vibration azimuth angle theta is shown in a formula (5):
α′=α+Δαcos[2(θ-θ α )] (5)
wherein-alpha' is an equivalent Blaine coefficient;
- θ is the standing wave azimuth;
——θ α an error angle is added to the Blaine coefficients.
According to the formula (5), the Blaine coefficient true value is obtained through calibration in a full-angle mode in a mode of the average and measurement information of the whole period, and the formula (6) is shown as follows:
Figure GDA0004133753010000041
further: in step 5, when active precession is employed, an additional drift angle is calculated
Figure GDA0004133753010000042
The formula is as follows:
Figure GDA0004133753010000043
wherein-SF is the force application scale;
——C p is an applied active precession signal.
The invention has the advantages and positive effects that:
1. according to the calibration correction method, the channel error is calculated and corrected on line in a mode of iteratively identifying the channel error parameter by independently moving the standing wave azimuth angle.
2. According to the calibration correction method, the additional error of angle calculation caused by the detection channel is corrected, and the accuracy of angle measurement is improved.
3. The calibration correction method corrects the additional error of the angle mapping coefficient to lead the angle mapping coefficient to tend to the Blaine coefficient, improves the dynamic characteristic and the angle detection nonlinearity, and improves the nonlinearity and the stability of the scale factor.
4. The calibration correction method reduces the extra drift rate caused by the driving channel, improves the angular resolution of the gyroscope and improves the zero offset stability of the gyroscope.
Drawings
FIG. 1 is a schematic plan view of a resonator;
FIG. 2 is a flow chart of a method for calibrating and correcting channel errors of a resonant gyroscope.
Detailed Description
The structure of the present invention will be further described by way of examples with reference to the accompanying drawings. It should be noted that the present embodiments are illustrative and not restrictive.
Fig. 1 is a schematic plan view of a harmonic oscillator, wherein the harmonic oscillator 1 is a core sensitive unit of a gyroscope, and materials of the harmonic oscillator can be quartz, silicon base, metal and the like according to different application requirements and precision grades. The electrodes 2 are used for driving and detecting the vibration of the harmonic oscillator, and comprise contact type and non-contact type, such as piezoelectric ceramics, capacitors and the like.
Fig. 2 is a flowchart of a method for calibrating and correcting channel errors of a resonant gyroscope according to the present invention.
The specific calibration correction steps and principles are as follows:
and step 1, establishing a channel error identification model, and placing the established model in a control system of the resonant gyroscope. The method comprises the following steps:
as for the channel error, it includes detecting the channel error a and driving the channel error B. Wherein the detection channel error A comprises electrode gain biasDifference Deltak d Electrode position deviation delta theta d Electrode phase shift deviation delta phi d . Electrode gain error Δk d The proportionality coefficient of vibration information reflected by the characterization orthogonal two-axis signals is inconsistent, so that the angle calculation
Figure GDA0004133753010000044
Non-linearities are created at different locations standing wave azimuth angles θ. Electrode position deviation delta theta d Characterization of the two-axis detection Signal V x 、V y The spatial position orthogonality is not strictly maintained, so the detected signal cannot truly reflect the two modes of vibration. Electrode phase shift deviation delta phi d Two-axis vibration information V representing the same time x 、V y Failing to be acquired synchronously, aliasing occurs in the time domain. Thereby the detection channel error a will commonly interfere with the angle +.>
Figure GDA0004133753010000051
Is biased, i.e. the calculated standing wave angle +.>
Figure GDA0004133753010000052
Real angle with standing wave->
Figure GDA0004133753010000053
There is an error related to the standing wave azimuth angle θ as shown in equation (1).
Figure GDA0004133753010000054
Wherein-a is the antinode amplitude;
b is the node amplitude;
——
Figure GDA0004133753010000055
calculating a standing wave angle;
——Δk d to detect electrode gain deviation;
——Δθ d to detect electrode position deviationDifference;
——Δφ d to detect electrode phase shift deviations.
The driving channel error B indicates that the driving V is applied with force X 、V Y In the event of errors in the electrodes and the lines, the actual effect of the applied force deviates from the expected, i.e. control signal (amplitude-stabilized control signal C a Quadrature control signal C q Active precession signal C p ) Coupling occurs on both modalities. Such defects may be equivalently drive electrode bias, respectively electrode gain bias Δk e Deviation of electrode position
Figure GDA0004133753010000056
And->
Figure GDA0004133753010000057
Electrode phase shift deviation delta phi e . For the drive channel error B, it is mainly manifested as cross-coupling of the control signals, thereby causing additional drift Δε at each standing wave azimuth angle θ e An error equation of the driving error B to the standing wave azimuth angle θ is established as shown in equation (2).
Figure GDA0004133753010000058
in-Deltak e Driving the electrode gain bias for X;
——
Figure GDA0004133753010000061
x, Y drive electrode position deviations;
——Δφ e phase shift deviation for Y driving electrode;
——Δε e introducing additional drift for drive error;
SF is the electrode force application scale factor;
——
Figure GDA0004133753010000062
inducing a standing wave azimuth drift angle for the driving error;
——C a is a stable control signal;
——C q is a quadrature control signal.
From equation (2), the additional drift term Δε e Is related to the azimuth angle theta of the standing wave and is derived from the harmonic control signal (amplitude-stabilized control signal C a Quadrature control signal C q Active precession signal C p ) Is coupled to the coupling of (a). In actual operation, due to the existence of the detection channel error A, the real angle of the standing wave
Figure GDA0004133753010000063
Since it is unknown, the standing wave angle θ in the error equation (2) needs to be rewritten as an angle calculation value (observation value)/(observation value)>
Figure GDA0004133753010000064
Obtaining a channel error identification model as shown in formula (3):
Figure GDA0004133753010000065
equation (3) is a seven-element one-time overrunning equation, and has an analytical solution, so that the error parameter can be solved and calculated according to the coupling state.
Step 2, determining the number n of error parameters to be identified according to task requirements, and calling a channel error identification model;
and (5) preparing before checking, and determining error parameters to be identified according to the working state and the precision grade requirement of the gyroscope. Due to the different physical sources of the error parameters, the stability of each parameter varies. For scenes with low requirements on environment state stability and precision, only partial parameters such as gain k and the like need to be identified; when the device is placed for a long time, the state change is large or the device is used with high precision, the whole parameters (the detection electrode gain deviation Deltak can be identified d Detecting electrode position deviation delta theta d Detecting electrode phase shift deviation delta phi d Gain deviation Deltak of driving electrode e Positional deviation of driving electrode
Figure GDA0004133753010000066
And->
Figure GDA0004133753010000067
Phase shift deviation delta phi of driving electrode e ). And if the number of parameters to be identified is large, the model complexity is high, the calculation cost is high, and the convergence speed is low. According to the number n of parameters to be identified, n independent observation data are required to be established for subsequent identification calculation.
Step 3, initializing a standing wave azimuth angle theta and placing the standing wave azimuth angle theta at a random initial position theta 0 . Specific:
excitation of vibration, rotation of vibration mode and detection of signal are carried out by electrode 2, and according to conventional full angle control, vector synthesis formula is adopted, and angle force application decomposition is carried out according to X axis and Y axis to generate drive electrode voltage V X 、V Y And realizing stable control of the gyro state of each standing wave azimuth angle theta. Initially, the standing wave azimuth angle theta is positioned at a random azimuth angle theta 0
Step 4, moving the standing wave azimuth angle theta to be positioned at the theta i =θ 0 +i pi/2n, i=1, …, n. Specific:
the rotation of the standing wave can be provided by the external carrier rotation speed omega, or by applying an active precession signal C p Providing. When active precession is applied, a precession signal C is calculated according to the application scale SF p And a rotation time t, to achieve a shift in the azimuth angle θ of the standing wave (i.e., θ t =θ 0 +C p SF.t). It should be noted that the applied voltage signal C is characterized by the applied force scale SF p And the generated standing wave rotation rate
Figure GDA0004133753010000071
Is different from the angle detection mapping coefficient, the brane coefficient alpha. In addition, the applied force scale SF is also affected by errors, so care should be taken to correct it during calibration to ensure additional drift Δε e Accuracy of the acquisition. The following description takes the external carrier rotation as an example, and if active precession is employed, there is the equation Ω=c p SF/alpha (for active precession and external carrier rotationConversion formula of operation
Step 5, calculating azimuth angles theta of the standing waves in the process of moving the azimuth angles theta of the standing waves in the step 4 for n times i Additional amount of angular drift at
Figure GDA0004133753010000072
Specific:
when the standing wave azimuth angle theta is moved to different positions theta i At this time, an additional drift angle is calculated
Figure GDA0004133753010000073
When external carrier is used to provide transfer Time of movementThe formula is as follows:
Figure GDA0004133753010000074
middle- (2)
Figure GDA0004133753010000075
Is an additional drift angle;
——
Figure GDA0004133753010000076
is the azimuth angle theta of the standing wave i Calculating the azimuth angle theta of the standing wave at the position;
-alpha is the Blaine coefficient truth value;
omega is the rotation speed of the external carrier;
t is the rotation time.
The Blaine coefficient true value alpha can be obtained through factory experiment calibration, and has very good stability because the Blaine coefficient true value alpha is only related to the geometric parameters of the harmonic oscillator, so the Blaine coefficient true value alpha can be used as a constant in the using process. The detection channel error matrix A has various anisotropic characteristics, so that the Coriolis force term in the harmonic oscillator dynamics equation generates additional errors, and the equivalent Braun coefficient alpha' (theta) caused by the additional errors becomes dependent on the vibration azimuth angle theta, and the formula is as follows:
α′=α+Δαcos[2(θ-θ α )] (5)
wherein-alpha' is an equivalent Blaine coefficient;
- θ is the standing wave azimuth;
——θ α an error angle is added to the Blaine coefficients.
According to the formula (5), the Blaine coefficient true value can be obtained through calibration in a full-angle mode in a mode of the average and measurement information of the whole period, and the formula (6) is shown as follows:
Figure GDA0004133753010000077
when active precession is employedThe formula is as follows:
Figure GDA0004133753010000078
wherein-SF is the force application scale;
——C p for applying active precession signals
Step 6, according to the additional drift angle
Figure GDA0004133753010000081
And the channel error identification model is used for identifying and calculating n error parameters. The coupling degree is used as an evaluation index for identification by acquiring n independent equations which are equal to the number of parameters to be corrected, and the identification calculation of each error parameter can be carried out by a system identification method. The identification method can adopt traditional least square method, recursive least square method and the like, and can also adopt advanced algorithms such as genetic algorithm, particle swarm algorithm and the like.
And 7, substituting the calculated error parameters into the corresponding positions of the channel error identification model established in the step 1, and correcting the current loop coefficient. Specifically, the identified parameters are corrected according to the analytic equations (1) and (2) to the loop. The convergence rate varies due to the different expression of the parameters.
Step 8, judging the calculation residual error e of each parameter k Whether or not the set termination condition e is satisfied k <e set And counting the number k of parameters subjected to correction. Specific: in order to reduce the calculation cost, accelerate the convergence process and the stability, set independent termination conditions for each parameter, and after one iteration is completed, identify the residual error e according to each parameter k (i.e. the difference between the current calculated value and the last calculated value) is less than a set threshold e set And counting the number k of parameters meeting the termination condition.
And 9, updating the number n of parameters to be identified and the identification model. Specific: when a certain parameter meets the termination condition e k <e set And (3) setting the corresponding parameter in the error equation in the step (1) as a calculated fixed value, and eliminating identification correction. The remainder not meeting the termination condition e k <e set And (3) continuing the identification calculation in the next iteration. At this time, the parameter number to be identified becomes n=n-k, and all parameter identification is completed until n=0, iteration is stopped, and correction is completed.
Step 10, if the parameter n to be identified is not zero, updating the random initial standing wave azimuth angle θ 0 =θ 0 And +r, returning to the step 2, and repeating the identification process until all parameters are corrected. Wherein, to generate random standing wave azimuth angle theta 0 =θ 0 +r as the initial azimuth θ of the current recognition 0 The reason for (2) is: in order to keep the random characteristic of each iteration data, the recognition result is prevented from falling into a local optimal solution.
Although the embodiments of the present invention and the accompanying drawings have been disclosed for illustrative purposes, those skilled in the art will appreciate that: various substitutions, changes and modifications are possible without departing from the spirit of the invention and the appended claims, and therefore the scope of the invention is not limited to the embodiments and the disclosure of the drawings.

Claims (5)

1. A method for calibrating and correcting channel errors of a resonant gyroscope is characterized by comprising the following steps of: the method comprises the following steps:
step 1, establishing a channel error identification model, and placing the established model in a control system of a resonant gyroscope;
step 2, determining the number n of error parameters to be identified according to task requirements, and calling a channel error identification model;
step 3, initializing a standing wave azimuth angle theta and placing the standing wave azimuth angle theta at a random initial position theta 0
Step 4, moving the standing wave azimuth angle theta to be positioned at the theta i =θ 0 +iπ/2n,i=1,…,n;
Step 5, calculating additional drift angles at each standing wave azimuth angle thetai in the process of moving the standing wave azimuth angle thetai n times in step 4
Figure QLYQS_1
Step 6, according to the additional drift angle
Figure QLYQS_2
The channel error identification model is used for identifying and calculating n error parameters;
step 7, substituting the calculated error parameters into the corresponding positions of the error model to correct the current loop coefficient;
step 8, judging the calculation residual error e of each parameter k Whether or not the set termination condition e is satisfied k <e set Counting the number k of parameters subjected to correction;
step 9, updating the number n of parameters to be identified and a channel error identification model;
step 10, if the parameter n to be identified is not zero, updating the random initial standing wave azimuth angle θ 0 =θ 0 +r, returning to step 2; otherwise, stopping iteration;
the channel errors involved in step 1 include a detection channel error a and a drive channel error B;
detecting channel error A includes electrode gain offset Δk d Electrode position deviation delta theta d Electrode phase shift deviation delta phi d For the detection channel error A, the standing wave angle is calculated
Figure QLYQS_3
Real angle with standing wave->
Figure QLYQS_4
There is an error related to the standing wave azimuth angle θ as shown in equation (1):
Figure QLYQS_5
wherein-a is the antinode amplitude;
b is the node amplitude;
——
Figure QLYQS_6
calculating a standing wave angle;
——Δk d to detect electrode gain deviation;
——Δθ d to detect electrode position deviations;
——Δφ d to detect the electrode phase shift deviation;
the driving channel error B includes the electrode gain deviation Deltak e Deviation of electrode position
Figure QLYQS_7
And->
Figure QLYQS_8
Electrode phase shift deviation delta phi e The method comprises the steps of carrying out a first treatment on the surface of the For the drive channel error B, it is mainly manifested as cross-coupling of the control signals, thereby causing additional drift Δε at each standing wave azimuth angle θ e An error equation of the driving error B to the standing wave azimuth angle theta is established as shown in a formula (2):
Figure QLYQS_9
in-Deltak e Driving the electrode gain bias for X;
——
Figure QLYQS_10
x, Y drive electrode position deviations;
——Δφ e phase shift deviation for Y driving electrode;
——Δε e introducing additional drift for drive error;
SF is the electrode force application scale factor;
——
Figure QLYQS_11
is an additional drift angle;
——C a is a stable control signal;
——C q is a quadrature control signal;
the real angle of the standing wave is detected by the existence of the channel error A
Figure QLYQS_12
Unknown, the standing wave angle θ in the driving error equation (2) is rewritten as an angle calculation value +.>
Figure QLYQS_13
Obtaining a channel error identification model as shown in formula (3):
Figure QLYQS_14
2. the method for calibrating and correcting the channel error of the resonant gyroscope according to claim 1, wherein the method comprises the following steps: in step 4, the rotation of the standing wave can be provided by the external carrier rotation speed omega, or by applying the active precession signal C p Providing.
3. The method for calibrating and correcting the channel error of the resonant gyroscope according to claim 2, wherein the method comprises the following steps: in step 5, an additional drift angle is calculated when the rotation is provided using the external carrier
Figure QLYQS_15
The formula is as follows:
Figure QLYQS_16
middle- (2)
Figure QLYQS_17
Is an additional drift angle;
——
Figure QLYQS_18
is the azimuth angle theta of the standing wave i Calculating the azimuth angle theta of the standing wave at the position;
-alpha is the Blaine coefficient truth value;
omega is the rotation speed of the external carrier;
t is the rotation time.
4. The method for calibrating and correcting the channel error of the resonant gyroscope according to claim 3, wherein the method comprises the following steps: the method for obtaining the real value of the Blaine coefficient comprises the following steps:
since the detection channel error matrix A has various anisotropic characteristics, the Coriolis force term in the harmonic oscillator dynamics equation generates additional errors, an equivalent Blaine coefficient is introduced, and the relation between the equivalent Blaine coefficient alpha' (theta) and the vibration azimuth angle theta is shown in a formula (5):
α′=α+Δαcos[2(θ-θ α )] (5)
wherein-alpha' is an equivalent Blaine coefficient;
- θ is the standing wave azimuth;
——θ α adding an error angle to the Blaine coefficient;
according to the formula (5), the Blaine coefficient true value is obtained through calibration in a full-angle mode in a mode of the average and measurement information of the whole period, and the formula (6) is shown as follows:
Figure QLYQS_19
5. the resonating gyroscope of claim 4The calibrating and correcting method for the channel error of the screw instrument is characterized by comprising the following steps of: in step 5, when active precession is employed, an additional drift angle is calculated
Figure QLYQS_20
The formula is as follows:
Figure QLYQS_21
wherein-SF is the force application scale;
——C p is an applied active precession signal.
CN202210246190.XA 2022-03-14 2022-03-14 Method for calibrating and correcting channel error of resonant gyroscope Active CN114543843B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202210246190.XA CN114543843B (en) 2022-03-14 2022-03-14 Method for calibrating and correcting channel error of resonant gyroscope

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202210246190.XA CN114543843B (en) 2022-03-14 2022-03-14 Method for calibrating and correcting channel error of resonant gyroscope

Publications (2)

Publication Number Publication Date
CN114543843A CN114543843A (en) 2022-05-27
CN114543843B true CN114543843B (en) 2023-06-20

Family

ID=81664406

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202210246190.XA Active CN114543843B (en) 2022-03-14 2022-03-14 Method for calibrating and correcting channel error of resonant gyroscope

Country Status (1)

Country Link
CN (1) CN114543843B (en)

Families Citing this family (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN115127533B (en) * 2022-08-31 2022-11-18 中国船舶重工集团公司第七0七研究所 Error fitting compensation method based on resonance gyroscope vibration mode rotation modulation
CN115855121B (en) * 2023-02-28 2023-04-28 中国船舶集团有限公司第七〇七研究所 Error self-calibration method of hemispherical resonant gyroscope
CN116465384B (en) * 2023-06-20 2023-08-18 中国船舶集团有限公司第七〇七研究所 Hemispherical resonator gyro drift error compensation method based on modal inversion

Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN110865580A (en) * 2019-11-27 2020-03-06 中国船舶重工集团公司第七0七研究所 Hemispherical resonant gyroscope fully-differential control system and control method based on time division multiplexing
CN112506040A (en) * 2020-11-16 2021-03-16 哈尔滨工程大学 Single-channel control system and method for full-angle hemispherical resonator gyroscope

Family Cites Families (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
RU1838761C (en) * 1991-06-13 1993-08-30 Гос. Нии@ Автоматических Систем Method of measurement of drift of gyro-inertial systems
JP4331211B2 (en) * 2004-02-04 2009-09-16 アトランティック・イナーシャル・システムズ・リミテッド Method to reduce bias error in vibrating structure gyroscope
CN103178909B (en) * 2011-12-26 2015-07-29 鼎桥通信技术有限公司 The fault detection method of standing wave measurement circuit and device
RU2526585C2 (en) * 2012-07-16 2014-08-27 Закрытое акционерное общество "Инерциальные технологии "Технокомплекса" (ЗАО "ИТТ") Determination of stationary wave orientation angle in solid-state wave gyro
CN103674064B (en) * 2013-12-06 2017-02-08 广东电网公司电力科学研究院 Initial calibration method of strapdown inertial navigation system
TWI681170B (en) * 2018-12-22 2020-01-01 國立清華大學 Calibration method of multiple inertial measurement units on multi-linkage system
CN111896026B (en) * 2020-05-11 2021-05-18 中国科学院地质与地球物理研究所 Self-calibration method and system of solid-state resonant gyroscope
US20210348503A1 (en) * 2020-05-11 2021-11-11 Institute Of Geology And Geophysics, Chinese Academy Of Sciences Self-calibration method and system of solid-state resonator gyroscope

Patent Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN110865580A (en) * 2019-11-27 2020-03-06 中国船舶重工集团公司第七0七研究所 Hemispherical resonant gyroscope fully-differential control system and control method based on time division multiplexing
CN112506040A (en) * 2020-11-16 2021-03-16 哈尔滨工程大学 Single-channel control system and method for full-angle hemispherical resonator gyroscope

Also Published As

Publication number Publication date
CN114543843A (en) 2022-05-27

Similar Documents

Publication Publication Date Title
CN114543843B (en) Method for calibrating and correcting channel error of resonant gyroscope
CN111896026B (en) Self-calibration method and system of solid-state resonant gyroscope
CN114509057B (en) Full-angle mode control method of resonant gyroscope
RU2423669C1 (en) Method of determining rotational speed of axially symmetric vibration sensor and inertial device for realising said method
EP0640207B1 (en) Calibration method for a relative heading sensor
US7120548B2 (en) Method of calibrating bias drift with temperature for a vibrating structure gyroscope
CN113686356B (en) Resonant gyro zero bias on-line self-compensation system and method based on RBF network
CN113551660B (en) Method for obtaining vibration mode angle of hemispherical resonance gyroscope when electrode angle has error
CN114858191B (en) Error calibration method for detecting electrode of full-angle hemispherical resonator gyroscope
RU2390728C1 (en) Method of setting up inertial navigation system with axially symmetric vibration sensor and corresponding inertial navigation system
CN115773741B (en) Hemispherical resonator gyroscope self-compensation control system and method
CN115127533B (en) Error fitting compensation method based on resonance gyroscope vibration mode rotation modulation
EP0704048A1 (en) Dither signal remover for dithered ring laser gyro
CN114370886B (en) Full-angle mode vibration gyro measurement error self-calibration method based on virtual rotation
CN113447047B (en) Rate integral gyroscope detection electrode error identification method, device, system and medium
CN114440933B (en) Self-correcting system for rotation modulation scale of resonant gyroscope
CN114166242B (en) Calibration method and system for hemispherical resonator gyro detection signal non-uniformity
WO2022174831A1 (en) Continuous north-seeking apparatus and method, electronic device, and storage medium
RU2528037C2 (en) Method and system for gyroscopic measurements with usage of vibration gyroscope
CN115077564B (en) Identification and compensation method for unbalanced error of hemispherical resonator gyro detection channel
US9927256B2 (en) Calibration of vibrating gyroscope
CN111578966A (en) Hemisphere harmonic oscillator characteristic parameter identification method based on LMS algorithm
JP4070879B2 (en) Electronic magnetic compass
CN114370887B (en) Zero self-calibration method of force balance mode vibration gyro based on virtual rotation
JP4075402B2 (en) Electronic compass

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
GR01 Patent grant
GR01 Patent grant